Apparatus and Method of Controlling Lower-Limb Joint Moments through Real-Time Feedback Training

ABSTRACT

A real-time estimation of 3D moments of lower-limb joints using a robotic multi-axis training system with a 6-axis force/torque (F/T) sensors and a 6-DOF goniometer is described. A joint moment such as the knee abduction moment (KAM) can be determined in real-time without using sophisticated optoelectronic motion tracking system. The system also does not require computation of the COP location. The knee adduction moment or any other lower-limb 3D joint moments can be determined conveniently during stepping movement on the training system for real-time biofeedback training on controlling the targeted joint moment(s). The 6-DOF goniometer is convenient to use with other analog signals including the 6-axis F/T and locomotion variables. As an example application, combined with the frontal plane movement on the robotic multi-axis elliptical trainer, it provides a useful tool suitable for clinical setting to help patients with knee OA to reduce potentially damaging peak knee adduction moment through real-time feedback training.

BACKGROUND OF INVENTION

More than 21% of adult Americans (46 million) have some form of diagnosed arthritis, and the number is anticipated to rise to 67 million by 2030 (Hootman and Helmick, 2006). The most common type of arthritis, osteoarthritis (OA), affected more than 27 million Americans (Lawrence et al., 2008). Nearly one-half of all adults and two-thirds of those who are obese can now be expected to develop symptomatic knee OA at some point in their lives (Murphy et al., 2008). Knee OA is a major contributor to functional impairment and reduced independence in older adults (Peat et al., 2001).

There is a growing recognition of the role of local neuromechanical factors in influencing physical function and knee OA disease progression. One such factor is varus-valgus laxity and dynamic instability. However, few exercise treatment strategies to target this particular biomechanical and neuromuscular impairment exist.

Although it is well recognized that knee OA is associated with excessive knee adduction moment (KAM) in the frontal plane, there has been a lack of convenient and effective ways of training people with knee OA in better dealing with the frontal plane knee adduction moment loading.

In general, one or more components of lower-limb joint moments may need to be better controlled through feedback training for the purposes of post-injury rehabilitation and injury prevention. There is a general need for real-time feedback training of selected joint moment(s).

The multi-axis rehabilitation system described here addresses such a need and provides us a useful tool to better control a certain joint moment through real-time biofeedback of the targeted joint moment(s).

BRIEF DESCRIPTION OF THE DRAWINGS

FIG. 1. Schematics of real-time knee moment computation and feedback training (a) A multi-DOF goniometer is used as the compact lower-limb motion measurement unit. (b) Inertial measurement unit is used as the compact lower-limb motion measurement unit.

FIG. 2. (a) Sagittal plane schematic diagram of a right-side lower limb with the proposed robotic multi-axis elliptical trainer (ET). Positive x_(o) direction is the lateral direction; Positive y_(o) direction the anterior direction. A circle centered at P₄ represents circular disk of the ET. A thick line from P₂ to P₃ represents the rod where the footplate is mounted on. World frame denotes the frame which is a fixed Lab. Ankle frame denotes a frame attached to foot and origin of frame is ankle joint center (JC), P_(a); knee frame denotes a frame attached to shank and origin of the frame is knee JC, P_(k), P_(Sk) and P_(Ft) denote positions of center of mass (COM) of the shank and the foot, respectively. (b) Frontal plane free body diagram (FBD) of a foot (triangle), and a 6-axis force/torque (F/T) sensor, located underneath the foot; the top vertex of the triangle, P_(a), represents ankle JC. Positive y_(a) direction is the anterior direction; positive x_(a) direction the lateral direction. Since the footplate, which is located between the foot and the 6-axis F/T sensor, is highly stiff, it is omitted for clarity. (c) FBD of the shank (thick vertical line) with the ankle JC (lower end of the rod) and the knee JC (upper end of the rod). From the forces thus measured with the 6-axis F/T sensor with the 3-dimensional (3D) translational and rotational accelerations of COM of the foot, forces and moments acting on the ankle JC are obtained. Consequently, using forces and moments acting on the ankle JC with the 3D translational and rotational accelerations of COM of the shank, 3D knee moments can be obtained. d₁ and h₁ denote the x_(a) and z_(a) direction coordinate differences between the F/T sensor (P_(F/T)), which is the point of action of measured forces/torques, and the COM of the foot (center of white circle, P_(Ft)), respectively; d₂ and h₂ the x_(a) and z_(a) direction coordinate differences between the ankle JC (P_(a)) and the COM of the foot (P_(Ft)), respectively; ^(a)a_(Ft) _(—) _(x) and ^(a)a_(Ft) _(—) _(z) the x_(a) and z_(a) direction translational accelerations of the COM of the foot, respectively; ^(a){umlaut over (θ)}_(Ft) _(—) _(y) the y_(a) (frontal) direction rotational acceleration of COM of the foot; ^(a)F_(F/T) _(—) _(x), ^(a)F_(F/T) _(—) _(z), ^(k)F_(F/T) _(—) _(x), and ^(k)F_(F/T) _(—) _(z) the x_(a), z_(a), x_(k) and z_(k) direction forces action on the bottom of the foot, respectively; ^(a)M_(F/T) _(—) _(j), and ^(a)M_(ay) the y_(a) (frontal) the direction moments measured with the 6-axis F/T sensor and computed at the ankle JC, respectively. ^(k)M_(ky) and ^(k)M_(ay) denote the y_(k) (frontal) direction moments at the knee JC and the ankle JC, respectively; ^(k)a_(Sk) _(—) _(x) and ^(k) a_(Sk) _(—) _(z) the x_(k) and z_(k) direction translational accelerations of COM of the shank, respectively; ^(a)F_(ax), ^(a)F_(az), ^(k)F_(ax), and ^(k)F_(az) denote the x_(a), z_(a), x_(k), and z _(k) direction forces acting on the ankle JC, respectively; ^(k)F_(k×), and ^(k)F_(kz) denote the x_(k) and z_(k) direction forces acting on the knee JC, respectively.

FIG. 3. 3D knee moment computation methods; (a) well-known typical methods (Winter, 2005; Zatsiorsky, 2002); (b) the proposed method, which does not require COP computation thanks to the features of the proposed robotic multi-axis ET.

FIG. 4. Schematic diagram of the robotic multi-axis ET with a lower limb. The distance from P₃ to P₄ is l₁; that of road from P₂ to P₃ is l₂; and that of from P_(F/T) to P₃ l_(2FT); that of from P_(pot), the location of potentiometer, to P₂ l_(ob). l₁, l₂, and l_(2FT) are known constants in advance once the ET dimension is decide whereas l_(ob) is measured with the potentiometer mounted at fixed point P_(pot).

FIG. 5. A six-DOF goniometer was used to measure ankle dorsiflexion/planar-flexion and inversion/eversion angles and shank internal/external rotation angle accurately in real-time. The upper 3-DOF part is firmly strapped to the bony frontal-medial surface of shank and lower 3-DOF part is attached to the footplate, which has no motion relative to foot. The ankle joint center (JC), midpoint between the medial and lateral malleoli, was aligned with the F/T sensor center. By using the 6-DOF goniometer, the ankle dorsiflexion/planar flexion angle (θ₁) and inversion/eversion angle (θ₂), and shank internal/external rotation angle (θ₃) can be measured with proper calibration. Rotation angles are defined by following the sequence of x-y-z Euler angle.

FIG. 6. Knee adduction moment (KAM) estimated during (a) normal stepping; (b) adducted stepping. KAM estimated with the 6-DOF goniometer (blue line) and with the Optotrak (red dashed line) matched each other closely. Peak KAM locations of the two methods in each cycle are almost identical.

COMPONENT LIST

-   1: Multi-axis force sensor -   2. Footplate -   3G: Multi-DOF goniometer -   3I: Inertial measurement unit (IMU) -   4: central processor -   5: feedback device -   6: foot strap -   7: pivoting -   8: sliding -   9: real-time calculation module -   10: motor -   11: position sensor

DETAILED DESCRIPTION OF THE INVENTION

An apparatus and method of 3-dimensional (3-D) knee and ankle moments and forces estimation method are described, which can be used for real-time feedback training on controlling one or more of the 3-D knee and/or ankle joint moments and forces without requiring the computation of center of pressure (COP)—the location of the vertical ground reaction force (GRF) vector from a force platform (FIG. 1).

The 3-D knee moments under real-time feedback control can be one of more moment components including knee flexion-extension, abduction-adduction, and internal-external rotation moments; and the 3-D knee forces can be one of more force components including lateral, anterior, and proximal translation forces. The 3-D ankle moments under real-time feedback control can be one of more moment components including dorsiflexion-plantar flexion, inversion-eversion and internal-external rotation moments; and the 3-D ankle forces can be one of more force components including lateral, anterior, and proximal translation forces.

For example, knee adduction moment (KAM), a widely used surrogate measure of medial knee compression (Foroughi et al., 2009; Komistek et al., 1999; Miyazaki et al., 2002; Polio et al., 2002; Reeves and Bowling, 2011; Shelburne et al., 2008; Simic et al., 2011), is significantly correlated with the severity of knee osteoarthritis (OA) (Foroughi et al., 2009; Reeves and Bowling, 2011; Simic et al., 2011), a disease affecting more than 27 million Americans (Lawrence et al., 2008); and is the cause of 60-80% of the compressive load at the medial tibiofemoral knee compartment (Foroughi et al., 2009). Especially, the largest peak of the KAM, which occurs during the load acceptance phase, is the strong predictor of medial compartment OA presence (Simic et al., 2011), radiographic disease severity (Sharma et al., 1998; Simic et al., 2011), rate of progression (Miyazaki et al., 2002), and the presence of OA symptoms (Thorp et al., 2007).

Thus, KAM estimated in real-time may enable the patients with knee OA to use it as a biofeedback in order to control the KAM during locomotion. Considering the wide usage of the ET, the real-time estimation of KAM during ET exercise may be beneficial to millions of patients with knee OA. Until now, there are no reports on real-time biofeedback of the KAM during the training but there are some reports on real-time feedback of dynamic knee frontal alignment (Barrios et al., 2010; Reeves and Bowling, 2011; Simic et al., 2011).

Since the emergence of the biomechanical and gait study, there has been extensive efforts on the estimation of 3D moments (as well as forces) with the advance of measurement technologies (Baker, 2006; Elftman, 1939; Koontz et al., 2006; Shiavi et al., 1987; Whittle, 1996; Winter, 2005; Zhang et al., 2003; Zhou and Hu, 2008), because the 3D moments of lower limb joints are important and provide valuable information in many disciplines including biomechanics, orthopedics, physical rehabilitation, and sports science. Examples are, to name just a few, assessing patients with a walking disorder (Whittle, 1996) based on the normal gait patterns (Elftman, 1939; Riley et al., 2001; Winter, 1984, 1980) and investigating association between KAM and biomechanical variables of patients with knee osteoarthritis (OA) (Foroughi et al., 2009; Hurwitz et al., 2002).

However, most current estimation methods need off-line post processing in order to obtain the moments and forces of lower limb joints. Moreover, there may be other potential difficulties in using readily available methods including a long duration of preparation of attaching markers on the parts of the lower limbs of interest for visual/non-visual motion tracking, occlusion at some points (phases) of gait with visual tracking system (e.g., Optotrak™), drift in the computation of velocity and position from accelerometer data, and distortion of sensed information of magnetic sensors due to the magnetic fields of other devices (e.g., electromagnetic motors and/or ferrite structures) (Zhou and Hu, 2008).

Besides, one of the differences of the proposed robotic multi-axis ET exercise and the ground walking (or the running) is that there is no relative motion between the foot and the footplate, because the bootstrap prevents motion of the foot relative to the footplate. Thus, the foot and the footplate always move together. In other words, the distance between the center of mass (COM) of the foot (P_(Ft)) and the center of the 6-axis Force/Torque (F/T) sensor (P_(F/T)), which is firmly mounted underneath the footplate, is time-invariant during the exercise. Moreover, due to the movement constraint imposed on the foot and the footplate, non-zero pure moment (also called couple), which is usually ignorable in normal walking and running in a gait lab setting (Cohen et al., 1980), is no longer negligible and may be applied to the footplate. Thus, the typical well established inverse dynamics methods (Winter, 2005; Zatsiorsky, 2002), which require the location of COP, is not applicable to the proposed robotic multi-axis ET exercise. Specifically, with a regular force plate in a gait lab setting, which gives same measured forces/moments as the 6-axis F/T sensor mounted on the proposed robotic multi-axis ET, the COP is computed under the assumption that there is no pure moment exerted on the force plate in the horizontal plane (i.e., zero T_(ax) and T_(ay)) (Cohen et al., 1980; Winter, 2005; Zatsiorsky, 2002). Therefore, it might not be applicable to use existing methods developed for the analysis of the over-ground walking and the running, because of the constrained foot movement.

Hence, in order to compute the 3D knee moments as well as other moments including ankle joint moments, a modified inverse dynamic method is described below, which does not involve the computation of location of COP and is tailored for the robotic multi-axis ET exercise.

1. Computation of COP

For the computation of the 3D knee moments and other lower limb moments, COP is generally needed in order to use well-established inverse dynamics methods based on Newton-Euler equation (Cohen et al., 1980; Winter, 2005; Zatsiorsky, 2002). A typical 3D knee moments computation method (Cohen et al., 1980; Winter, 2005; Zatsiorsky, 2002) may be summarized as follows (FIG. 3( a)): from the anthropometry data given in (Winter, 2005; Zatsiorsky, 2002) or some other reliable sources, kinematic and dynamic parameters including coordinates of COM, mass and inertia with respect to the COM of each segment (in this case, foot and shank) are obtained; COP is obtained using forces and moments measured with the force plate; translational and rotational accelerations are obtained from a motion tracking device (e.g. Optotrak); one can then compute moment (M_(a)ε

³) and force (F_(a)ε

³) vectors acting on the ankle using the inverse dynamics with GRF and COP; consequently, from M_(a) and F_(a) thus computed, knee moment vector (M_(k)ε

³) can be obtained.

Specifically, COP is required to compute the net moment acting on the foot. With the measured forces and moments, which correspond to F_(F/T) _(—) _(x), F_(F/T) _(—) _(z) and M_(F/T) _(—) _(y), in FIG. 2, and COP, net resultant foot y direction moment (M_(y) _(—) _(net)), which is equated to the same direction foot inertial torque, can be expressed as follows¹ (Winter, 2005): ¹Here, for simplicity, it is assumed that the footplate is in horizontal plane (i.e. β=0) and all equations are written with respect to world frame without loss of generality. Thus, left-superscripts, which represent frame of references, are omitted.

M _(y) _(—) _(net) =−F _(F/T) _(—) _(z)(d ₁ +x _(cop))+F _(F/T) _(—) _(x) h ₁ +M _(ay) −F _(az) d ₂ +F _(ax) h ₂  (1)

where

h ₁ −z _(F/T) −z _(Ft)  (2)

h ₂ =z _(a) −z _(Ft)  (3)

d ₁ =x _(F/T) −x _(Ft)  (4)

d ₂ =x _(a) −x _(Ft)  (5)

P_(Ft)=[x_(Ft) y_(Ft) z_(Ft)]^(T) and P_(a)=[x_(a) y_(a) z_(a)]^(T) denote coordinates of the COM of the foot, and that of ankle, respectively; x_(cop) denotes the x direction coordinate difference between F/T sensor center and the COP, and can be computed as below

x _(cop) =x _(cp) −x _(F/T)  (6)

where P_(F/T)=[x_(F/T) y_(F/T) z_(F/T)]^(T) and P_(cp)=[x_(cp) y_(cp) z_(cp)]^(T) denote coordinates of center of F/T sensor and that of COP.

Thus, computing location of COP is an important part of the knee moment computation. In (Winter, 2005), of course, a COP computing method with regular force plate when there is no pure moment (also called couple) in horizontal direction (i.e., x_(a) and y_(a) direction in FIG. 2( b)) can be found. Again, outputs of regular support force plate are the same as those of the 6-axis F/T sensor mounted on the proposed robotic multi-axis ET.

In general, the y direction moment measured with the 6-axis F/T sensor M_(F/T) _(—) _(y) can be represented with forces F_(F/T) _(—) _(x) and F_(F/T) _(—) _(y) and pure moment T_(y) as follows (e.g., see AMTI or Bertec technical note or User manual):

M _(F/T) _(—) _(y) =F _(F/T) _(—) _(x) z _(off) −F _(F/T) _(—) _(z) x _(cop) +T _(y)  (7)

where z_(off) denotes the z direction distance between center of the 6-axis F/T sensor and the top surface of the sensor (plus footplate thickness). Note that (7) is a generalization of the relation of the COP with the forces and moments acting on a force plate in that, compared with the COP computation method given in Winter (2005), non-zero pure moment T_(y) is included. It is assumed in (Winter, 2005) that T_(y) is zero (i.e. T_(y)=0), thus from (7), the x direction component of COP, x_(cop), was obtained as follows:

x _(cop)=(F _(F/T) _(—) _(x) z _(off) −M _(F/T) _(—) _(y))/F _(F/T) _(—) _(z)  (8)

One disadvantage of using (8) is that if F_(F/T) _(—) _(z) is small (<2% of body weight), x_(cop) is sensitive to the change of F_(F/T) _(—) _(z) and thus can be incorrect due to the measurement noise accompanied with F_(F/T) _(—) _(z) (Winter, 2005). Moreover, if T_(y) is not zero—which is the case of the proposed robotic multi-axis ET training—COP cannot be computed using (8). It should be noted that the aim of this specific research is not to find COP but to compute 3D knee and ankle moments.

In order to remove the requirement of the COP location from net moment calculation in (1), advantages of the proposed robotic multi-axis ET are utilized. As was mentioned, the distance between the COM of foot (P_(Ft)) and the 6-axis F/T sensor (P_(F/T)) is fixed; so is the distance between the ankle joint (P_(a)) and the COM of foot (P_(Ft)). In other words, once a subject's anthropometric data is obtained, d₁, d₂, h₁ and h₂ in FIG. 2( b) are known and time-invariant during the exercise. Thus, net y direction moment acting on the COM of the foot, M_(y) _(—) _(net) given in (1), can be rewritten as follows:

M _(y) _(—) _(net) =F _(F/T) _(—) _(x) h ₁ −F _(F/T) _(—) _(z) d ₁ +M _(F/T) _(—) _(y) +F _(ax) h ₂ −F _(az) d ₂ +M _(ay)  (9)

Obviously, (9) does not require the COP location. Moreover, all the distances (d₁, d₂, h₁ and h₂) are time-invariant (i.e., constants) during the exercise. Thus, these distances can be computed off-line, whereas COP requires a real-time online computation for the real-time computation of the 3D knee and ankle moments (and forces). Accordingly, the problem of potential incorrectness of x_(cop) computation in (8) due to high sensitivity under the small F_(F/T) _(—) _(z) (Winter, 2005) is removed.

Based on (9), the 3D knee moments and forces (and ankle moments and forces) computation can be simplified as shown in FIG. 3( b). Compared with the typical methods (Cohen et al., 1980; Winter, 2005; Zatsiorsky, 2002), the COP computation is no longer needed.

In short, due to the design of the robotic multi-axis ET, 3D knee and ankle moments and forces can be computed without computing COP location. In the following, the details of the proposed 3D knee and ankle moments computation method are provided by exemplifying the computation of the knee abduction/adduction moment. In case, if the foot is not strapped to footplate, then the usual COP calculation can still be utilized for the computation of knee and ankle forces and moments.

2. Derivation of Dynamic Equations for Real-Time Computation of 3D Moments of Lower Limb Joints

In this section, dynamic equations for real-time computation of 3D moments and forces of lower limb joints are provided with a simple 6-DOF goniometer based kinematic measurement technique.

1) Computation of Kinematic Variables

For the computation of 3D knee and ankle moments, kinematic information, which include positions, velocities, and accelerations of the joints and those of COM of segments, and joint angles, angular velocities and accelerations, are required. Specifically, one can compute the 3D knee moments with footplate angle (β), ankle dorsiflexion/planar-flexion (θ₁), inversion/eversion (θ₂), and shank internal/external rotation (θ₃) angles, and shank length (L_(Sk)) between knee joint and ankle joint, length between knee joint and COM of shank (L_(Sk) _(—) _(com)), and footplate (or ankle) position, velocity, and acceleration.

A. Kinematic Variables from the Robotic Multi-Axis Elliptical Trainer

Footplate angle (β) and footplate position can be computed using P₂ position (FIG. 4) measured along the oblique ramp direction with a precision potentiometer (l_(ob)). Considering the serial linkages from P₂ to P₃ with length l₂ and from P₃ to P₄ with length l₁, because the motion of P₂ is constrained by the oblique ramp, once the position of P₂ is measured then the two angles (φ₁, φ₂) can be obtained using a simple inverse kinematics. With the l_(ob) measured and y and z direction coordinates of P_(pot) with respect to the world frame (i.e., ^(o)y_(pot) and ^(o)z_(pot)), one can express the y and z coordinates of P₂ with respect to the world frame (^(o)y₂ and ^(o)z₂) as follows:

$\begin{matrix} \left\{ \begin{matrix} {{{}_{}^{}{}_{}^{}} = {{{- l_{ob}}{\cos (\alpha)}} + {{}_{}^{}{}_{}^{}}}} \\ {{{}_{}^{}{}_{}^{}} = {{{- l_{ob}}{\sin (\alpha)}} + {{}_{}^{}{}_{}^{}}}} \end{matrix} \right. & (10) \end{matrix}$

where α denotes the angle between the ground and the oblique ramp in the front part of the robotic multi-axis ET. Since α, ^(o)y_(pot), and ^(o)z_(pot) are constants, once l_(ob) is measured with the potentiometer located at P_(pot), ^(o)y₂ and ^(o)z₂ can be obtained.

^(o)y₂ and ^(o)z₂ can be also expressed using the two angles (θ₁, θ₂) and lengths (l₁ and l₂)

$\begin{matrix} \left\{ \begin{matrix} {{{}_{}^{}{}_{}^{}} = {{l_{1}{\cos \left( \varphi_{1} \right)}} + {l_{2}{\cos \left( {\varphi_{1} + \varphi_{2}} \right)}}}} \\ {{{}_{}^{}{}_{}^{}} = {{l_{1}{\sin \left( \varphi_{1} \right)}} + {l_{2}{\sin \left( {\varphi_{1} + \varphi_{2}} \right)}}}} \end{matrix} \right. & (11) \end{matrix}$

From (11), φ₁, φ₂ can be obtained as follows (Craig, 1989):

$\begin{matrix} \left\{ {\begin{matrix} {\varphi_{1} = {{\tan^{- 1}\left( \frac{{}_{}^{}{}_{}^{}}{{}_{}^{}{}_{}^{}} \right)} - {\tan^{- 1}\left( \frac{l_{2}{\sin \left( \varphi_{2} \right)}}{l_{1} + {l_{2}{\cos \left( \varphi_{2} \right)}}} \right)}}} \\ {\varphi_{2} = {\tan^{- 1}\left( \frac{\sin \left( \varphi_{2} \right)}{\cos \left( \varphi_{2} \right)} \right)}} \end{matrix}{where}} \right. & (12) \\ \left\{ \begin{matrix} {{\cos \left( \varphi_{2} \right)} = \frac{{{}_{}^{}{}_{}^{}} + {{}_{}^{}{}_{}^{}} - \left( {l_{1}^{2} + l_{2}^{2}} \right)}{2l_{1}l_{2}}} \\ {{\sin \left( \varphi_{2} \right)} = \left\{ \begin{matrix} {- \sqrt{1 - {\cos^{2}\left( \varphi_{2} \right)}}} & \begin{matrix} {{if}\mspace{14mu} {footplate}\mspace{14mu} {is}\mspace{14mu} {in}\mspace{14mu} {upper}} \\ {{position}\mspace{14mu} \left( {{180{^\circ}} < \varphi_{2} \leq {360{^\circ}}} \right)} \end{matrix} \\ \sqrt{1 - {\cos^{2}\left( \varphi_{2} \right)}} & \begin{matrix} {{if}\mspace{14mu} {footplate}\mspace{14mu} {is}\mspace{14mu} {in}\mspace{14mu} {lower}} \\ {{position}\mspace{14mu} \left( {{0{^\circ}} < \varphi_{2} \leq {180{^\circ}}} \right)} \end{matrix} \end{matrix} \right.} \end{matrix} \right. & (13) \end{matrix}$

Thus, θ₁ and θ₂ can be obtained with ^(o)y₂ and ^(o)z₂ directly computed from l_(ob) measured with a potentiometer located at P₂. Although there are two inverse kinematics solutions for a given P₂ position, however, a correct one can be easily selected with initial condition such as starting position. With φ₁, φ₂ thus measured, footplate angle (β) can be easily derived as below)

β=φ₁+φ₂  (14)

From simple forward kinematics, P_(F/T) the 6-axis F/T sensor y and z coordinates with respect to world frame can be computed with φ₁ and φ₂ as below

$\begin{matrix} \left\{ \begin{matrix} {{{}_{}^{}{}_{F/T}^{}} = {{l_{1}{\cos \left( \varphi_{1} \right)}} + {l_{2{FT}}{\cos \left( {\varphi_{1} + \varphi_{2}} \right)}}}} \\ {{{}_{}^{}{}_{F/T}^{}} = {{l_{1}{\sin \left( \varphi_{1} \right)}} + {l_{2{FT}}{\sin \left( {\varphi_{1} + \varphi_{2}} \right)}}}} \end{matrix} \right. & (15) \end{matrix}$

If the footplate and the 6-axis F/T sensor below the plate is rotating or sliding, angle of rotation or sliding distance can be incorporated into the computation of location of the F/T sensor (P_(F/T)) in (15).

B. Kinematic Variables from the 6-Axis Goniometer

In order to measure the ankle dorsiflexion/planar-flexion angle (θ₁), inversion/eversion angle (θ₂), and shank internal/external rotation angle (θ₃) in real-time, a low-cost 6 degree-of-freedom (DOF) goniometer (FIG. 5), which can be conveniently connected to any analog to digital (A/D) data acquisition devices with other analog signals including the 6-axis forces/torques and locomotion variables, can be utilized without time consuming preparation (Shiavi et al., 1987; Zhang et al., 2003). The only preparation required is to calibrate the initial angles with a simple calibration plate, on which all potentiometer angles of the 6-DOF goniometer are at known positions (Shiavi et al., 1987; Zhang et al., 2003). Note that the zero angles of 6-axis goniometer, calibrated with the calibration plate, are not the same as zero anatomical angles of dorsiflexion/planar-flexion, inversion/eversion and internal/external rotation.

In order to calculate the ankle dorsiflexion/planar-flexion, inversion/eversion, and internal/external rotation angle using the 6-DOF goniometer, before start training on ET, subject is asked to stand straight by trying to align knee joint with laser pointer lights coming from lateral (and medial) side and from front. The laser pointer at the lateral side of footplate is aligned with center of F/T sensor (i.e., y coordinate of the laser pointer with respect to ankle frame is the same as that of 6-axis F/T sensor) and can be tilted vertically up and down in x_(a)-z_(a) plane with respect to ankle frame. The laser pointer at the front size of footplate is located in front of 2^(nd) toe (i.e., x coordinate of center of ankle with respect to ankle frame and that of the laser pointer is identical) and also can be tilted vertically up and down in y_(a)-z_(a) plane with respect to ankle frame. By this way, one can find a posture that can be regarded as ‘zero degree posture’ (i.e., 0° dorsiflexion/planar-flexion, 0° inversion/eversion, 0° internal/external rotation).

Once the knee joint alignment is confirmed by checking the laser lights, the 6 angles of goniometers and the rotation matrix from the last (6^(th)) frame (attached to the bony surface of shank) to the base frame of the 6-axis goniometer (attached to the footplate) at that time (_(lg) ^(bg)R₁) are saved. Thus, one can compute rotation matrix from knee frame to ankle frame as follows (Shiavi et al., 1987; Zhang et al., 2003):

_(k) ^(a) R= _(lg) ^(bg) R(_(lg) ^(bg) R)⁻¹  (16)

where _(bg) ^(lg)R denotes rotation matrix from base frame to last frame of the 6-axis goniometer. From ankle dorsiflexion/planar-flexion (θ₁) and inversion/eversion (θ₂) angles and shank internal/external rotation angle (θ₃), _(k) ^(a)R can be also obtained as follows:

$\begin{matrix} \begin{matrix} {{\,_{k}^{a}R} = \begin{bmatrix} {{}_{}^{}{}_{}^{}} & {{}_{}^{}{}_{}^{}} & {{}_{}^{}{}_{}^{}} \\ {{}_{}^{}{}_{}^{}} & {{}_{}^{}{}_{}^{}} & {{}_{}^{}{}_{}^{}} \\ {{}_{}^{}{}_{}^{}} & {{}_{}^{}{}_{}^{}} & {{}_{}^{}{}_{}^{}} \end{bmatrix}} \\ {= \begin{bmatrix} {C\; \theta_{2}C\; \theta_{3}} & {{- C}\; \theta_{2}S\; \theta_{3}} & {S\; \theta_{2}} \\ {{S\; \theta_{1}S\; \theta_{2}C\; \theta_{3}} + {C\; \theta_{1}S\; \theta_{3}}} & {{{- S}\; \theta_{1}S\; \theta_{2}S\; \theta_{3}} + {C\; \theta_{1}C\; \theta_{3}}} & {{- S}\; \theta_{1}C\; \theta_{2}} \\ {{{- C}\; \theta_{1}S\; \theta_{2}C\; \theta_{3}} + {S\; \theta_{1}S\; \theta_{3}}} & {{C\; \theta_{1}S\; \theta_{2}S\; \theta_{3}} + {S\; \theta_{1}C\; \theta_{3}}} & {C\; \theta_{1}C\; \theta_{2}} \end{bmatrix}} \end{matrix} & (17) \end{matrix}$

where _(k) ^(a)r_(1j) denotes i,j^(th) element of _(k) ^(a)R obtained from (16). Note that, although the 6-DOF goniometer has a one translational DOF and a potentiometer for measuring the translation, this information is not required for computing _(k) ^(a)R. Clearly, from (16) and (17), one can obtain the three angles (θ₁, θ₂, θ₃) as follows:

$\begin{matrix} {{\theta_{1} = {\tan^{- 1}\left( \frac{- {{}_{}^{}{}_{}^{}}}{{}_{}^{}{}_{}^{}} \right)}},{\theta_{2} = {\tan^{- 1}\left( \frac{{}_{}^{}{}_{}^{}}{{{- S}\; \theta_{1}{{}_{}^{}{}_{}^{}}} + {C\; \theta_{1}{{}_{}^{}{}_{}^{}}}} \right)}},{\theta_{3} = {\tan^{- 1}\left( \frac{- {{}_{}^{}{}_{}^{}}}{{}_{}^{}{}_{}^{}} \right)}}} & (18) \end{matrix}$

From (18), one can select a proper solution because the dorsiflexion/planar-flexion, inversion/eversion and internal/external rotation angles must be between ±90° during normal exercise.

By using a digitizer (e.g., Microscribe or probe of Optotrak) or referring anthropometric data (Winter, 2005; Zatsiorsky, 2002), the length of shank, L_(Sk), from ankle to knee joint can be measured. Moreover, with L_(Sk) thus measured, the length between knee JC and COM of shank, L_(Sk) _(—) _(com) can be obtained by referring anthropometric data. Note that the two lengths (L_(Sk), L_(Sk) _(—) _(com)) are constant values for each subject, thus only one time off-line measurement is required for each subject unless the subject is growing during the training period. Depending on the joint and forces/moments of interest, not all of the angles are required for the computation as shown in table I.

2) Derivation of Equations of Motion for Computation of 3D Moments of Lower Limb Joints

For the derivation of knee moment, available variables, which can be known in advance or measured/estimated, are listed below.

1) Ankle position with respect to the world frame

^(o) P _(a)=[^(o) x _(a) ^(o) y _(a) ^(o) z _(a)]^(T)  (19)

with respect to the ankle frame

^(o) P _(a)=[000]^(T)  (20)

and with respect to the knee frame

^(k) P _(a)=[00−L _(sk)]^(T)  (21)

2) Knee position with respect to the knee frame

^(k) P _(k)=[^(k) x _(k) ^(k) y _(k) ^(k) z _(k)]^(T)=[000]^(T).  (22)

3) Shank COM position with respect to the knee frame

^(k) P _(Sk)=[^(k) x _(Sk) ^(k) y _(Sk) ^(k) z _(Sk)]^(T)=[00−L _(Sk) _(—) _(com)]^(T)  (23)

4) COM of foot position with respect to the ankle frame

^(a) P _(Ft)=[^(a) x _(Ft) ^(a) y _(Ft) ^(a) z _(Ft)]^(T)  (24)

which is a constant vector (i.e., ^(a)x_(Ft), ^(a)y_(Ft), and ^(a)z_(Ft) are constants). 5) Center of 6-axis F/T sensor position with respect to the ankle frame

^(a) P _(F/T)=[^(a) x _(F/T) ^(a) y _(F/T) ^(a) z _(F/T)]^(T)  (25)

which is a constant vector (i.e., ^(a)x_(F/T), ^(a)y_(F/T) and ^(a) z_(F/T) are constants). 6) 6-axis measurement of forces and torques exerted on foot by robotic multi-axis ET with respect to the ankle frame

^(a) F _(F/T)=[^(a) F _(F/T) _(—) _(x) ^(a) F _(F/T) _(—) _(y) ^(a) F _(F/T) _(—) _(z)]^(T)  (26)

and

^(a) M _(F/T)=[^(a) M _(F/T) _(—) _(x) ^(a) M _(F/T) _(—) _(y) ^(a) M _(F/T) _(—) _(z)]^(T)  (27)

7) Angular acceleration of foot with respect to the world frame and the ankle frame

^(a){umlaut over (θ)}_(Ft)=^(o){umlaut over (θ)}_(Ft)=[{umlaut over (β)}00]^(T).  (28)

8) Angular velocity and acceleration of shank with respect to the knee frame

$\begin{matrix} {{{}_{}^{}{\theta.}_{}^{}} = \begin{bmatrix} {{\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)C\; \theta_{2}C\; \theta_{3}} + {{\overset{.}{\theta}}_{2}S\; \theta_{3}}} \\ {{{- \left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)}C\; \theta_{2}S\; \theta_{3}} + {{\overset{.}{\theta}}_{2}C\; \theta_{3}}} \\ {{\left( {{\overset{.}{\theta}}_{1} + \beta} \right)S\; \theta_{2}} + {\overset{.}{\theta}}_{3}} \end{bmatrix}} & (29) \\ {{{}_{}^{}{\theta ¨}_{}^{}} = \begin{bmatrix} {{\left( {{\overset{¨}{\theta}}_{1} + \overset{¨}{\beta}} \right)C\; \theta_{2}C\; \theta_{3}} + {{\overset{¨}{\theta}}_{2}S\; \theta_{3}} - {\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)\left( {{{\overset{.}{\theta}}_{2}S\; \theta_{2}C\; \theta_{3}} + {{\overset{.}{\theta}}_{3}C\; \theta_{2}S\; \theta_{3}}} \right)} + {{\overset{.}{\theta}}_{2}{\overset{.}{\theta}}_{3}C\; \theta_{3}}} \\ {{{- \left( {{\overset{¨}{\theta}}_{1} + \overset{¨}{\beta}} \right)}C\; \theta_{2}S\; \theta_{3}} + {{\overset{¨}{\theta}}_{2}C\; \theta_{3}} + {\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)\left( {{{\overset{.}{\theta}}_{2}S\; \theta_{2}S\; \theta_{3}} - {{\overset{.}{\theta}}_{3}C\; \theta_{2}C\; \theta_{3}}} \right)} - {{\overset{.}{\theta}}_{2}{\overset{.}{\theta}}_{3}S\; \theta_{3}}} \\ {{\left( {{\overset{¨}{\theta}}_{1} + \overset{¨}{\beta}} \right)S\; \theta_{2}} + {\overset{¨}{\theta}}_{3} + {\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right){\overset{.}{\theta}}_{2}C\; \theta_{2}}} \end{bmatrix}} & (30) \end{matrix}$

9) Rotation matrix from the ankle frame to the world frame

$\begin{matrix} {{\,_{a}^{o}R} = \begin{bmatrix} 1 & 0 & 0 \\ 0 & {C\; \beta} & {{- S}\; \beta} \\ 0 & {S\; \beta} & {C\; \beta} \end{bmatrix}} & (31) \end{matrix}$

10) Rotation matrix from the world frame to the ankle frame

$\begin{matrix} {{\,_{o}^{a}R} = \begin{bmatrix} 1 & 0 & 0 \\ 0 & {C\; \beta} & {S\; \beta} \\ 0 & {{- S}\; \beta} & {C\; \beta} \end{bmatrix}} & (32) \end{matrix}$

11) Rotation matrix from the ankle frame to the knee frame

$\begin{matrix} {{\,_{a}^{k}R} = \begin{bmatrix} {C\; \theta_{2}C\; \theta_{3}} & {{S\; \theta_{1}S\; \theta_{2}C\; \theta_{3}} + {C\; \theta_{1}S\; \theta_{3}}} & {{{- C}\; \theta_{1}S\; \theta_{2}C\; \theta_{3}} + {S\; \theta_{1}S\; \theta_{3}}} \\ {{- C}\; \theta_{2}S\; \theta_{3}} & {{{- S}\; \theta_{1}S\; \theta_{2}S\; \theta_{3}} + {C\; \theta_{1}C\; \theta_{3}}} & {{C\; \theta_{1}S\; \theta_{2}S\; \theta_{3}} + {S\; \theta_{1}C\; \theta_{3}}} \\ {S\; \theta_{2}} & {{- S}\; \theta_{1}C\; \theta_{2}} & {C\; \theta_{1}C\; \theta_{2}} \end{bmatrix}} & (33) \end{matrix}$

12) Rotation matrix from the knee frame to the world frame

$\begin{matrix} {{\,_{k}^{o}R} = \begin{bmatrix} {C\; \theta_{2}C\; \theta_{3}} & {{- C}\; \theta_{2}S\; \theta_{3}} & {S\; \theta_{2}} \\ {{{S\left( {\beta + \theta_{1}} \right)}S\; \theta_{2}C\; \theta_{3}} + {{C\left( {\beta + \theta_{1}} \right)}S\; \theta_{3}}} & {{{- {S\left( {\beta + \theta_{1}} \right)}}S\; \theta_{2}S\; \theta_{3}} + {{C\left( {\beta + \theta_{1}} \right)}C\; \theta_{3}}} & {{- {S\left( {\beta + \theta_{1}} \right)}}C\; \theta_{2}} \\ {{{- {C\left( {\beta + \theta_{1}} \right)}}S\; \theta_{2}C\; \theta_{3}} + {{S\left( {\beta + \theta_{1}} \right)}S\; \theta_{3}}} & {{{C\left( {\beta + \theta_{1}} \right)}S\; \theta_{2}S\; \theta_{3}} + {{S\left( {\beta + \theta_{1}} \right)}C\; \theta_{3}}} & {{C\left( {\beta + \theta_{1}} \right)}C\; \theta_{2}} \end{bmatrix}} & (34) \end{matrix}$

13) Gravitational acceleration vector with respect to the world frame

^(o) g=[00−g] ^(T)  (35)

with respect to the ankle frame

^(a) g= _(o) ^(a) R ^(o) g=[0−gSβ−gCβ] ^(T)  (36)

with respect to the knee frame

$\begin{matrix} {{\,^{k}g} = {{{{}_{}^{}{}_{\;}^{}}g} = {\begin{bmatrix} {- {g\left\lbrack {{{- {C\left( {\beta + \theta_{1}} \right)}}S\; \theta_{2}C\; \theta_{3}} + {{S\left( {\beta + \theta_{1}} \right)}S\; \theta_{3}}} \right.}} \\ {- {g\left\lbrack {{{C\left( {\beta + \theta_{1}} \right)}S\; \theta_{2}S\; \theta_{3}} + {{S\left( {\beta + \theta_{1}} \right)}C\; \theta_{3}}} \right\rbrack}} \\ {{- {{gC}\left( {\beta + \theta_{1}} \right)}}C\; \theta_{2}} \end{bmatrix}.}}} & (37) \end{matrix}$

From (19), (23) and (34), COM of shank position with respect to the world frame can be computed as follows:

$\begin{matrix} {{{}_{}^{}{}_{}^{}} = {\begin{bmatrix} {{{}_{}^{}{}_{}^{}} - {L_{Sk\_ com}S\; \theta_{2}}} \\ {{{}_{}^{}{}_{}^{}} + {L_{Sk\_ com}{S\left( {\theta_{1} + \beta} \right)}C\; \theta_{2}}} \\ {{{}_{}^{}{}_{}^{}} - {L_{Sk\_ com}{C\left( {\theta_{1} + \beta} \right)}C\; \theta_{2}}} \end{bmatrix}.}} & (38) \end{matrix}$

By taking 2^(nd) order time derivative of both side (38) and multiplying _(o) ^(k)R, the transpose of _(k) ^(o)R given in (34), on both side, acceleration of COM of shank, ^(k)a_(Sk), can be obtained as follows:

$\begin{matrix} {{{}_{}^{}{}_{}^{}} = \begin{bmatrix} {{C\; \theta_{2}C\; \theta_{3}^{o}{\overset{¨}{x}}_{a}} + {\left\lbrack {{{S\left( {\beta + \theta_{1}} \right)}S\; \theta_{2}C\; \theta_{3}} + {{C\left( {\beta + \theta_{1}} \right)}S\; \theta_{3}}} \right\rbrack^{o}{\overset{¨}{y}}_{a}}} \\ {{+ \left\lbrack {{{- {C\left( {\beta + \theta_{1}} \right)}}S\; \theta_{2}C\; \theta_{3}} + {{S\left( {\beta + \theta_{1}} \right)}S}\; - \theta_{3}} \right\rbrack}{{}_{}^{}{z¨}_{}^{}}} \\ {+ {L_{Sk\_ com}\left\lbrack {{C\; \theta_{2}S\; {\theta_{3}\left( {{\overset{¨}{\theta}}_{1} + \overset{¨}{\beta}} \right)}} - {C\; \theta_{3}{\overset{¨}{\theta}}_{2}}} \right.}} \\ \left. {{{+ 0.5}\; {S\left( {2\; \theta_{2}} \right)}C\; {\theta_{3}\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)}^{2}} - {2S\; \theta_{2}S\; {\theta_{3}\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)}{\overset{.}{\theta}}_{2}}} \right\rbrack \\ \; \\ {{{- C}\; \theta_{2}S\; \theta_{3}{{}_{}^{}{x¨}_{}^{}}} + {\left\lbrack {{{C\left( {\beta + \theta_{1}} \right)}C\; \theta_{3}} - {{S\left( {\beta + \theta_{1}} \right)}S\; \theta_{2}S\; \theta_{3}}} \right\rbrack {{}_{}^{}{y¨}_{}^{}}}} \\ {{+ \left\lbrack {{{S\left( {\beta + \theta_{1}} \right)}C\; \theta_{3}} + {{C\left( {\beta + \theta_{1}} \right)}S\; \theta_{2}S\; \theta_{3}}} \right\rbrack}{{}_{}^{}{z¨}_{}^{}}} \\ {{+ L_{Sk\_ com}}\left\{ {{{+ C}\; \theta_{2}C\; {\theta_{3}\left( {{\overset{¨}{\theta}}_{1} + \overset{¨}{\beta}} \right)}} + {S\; \theta_{3}{\overset{¨}{\theta}}_{2}}} \right.} \\ \left. {{{+ 0.5}{S\left( {2\; \theta_{2}} \right)}S\; {\theta_{3}\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)}^{2}} - {2\; \theta_{2}C\; {\theta_{3}\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)}{\overset{.}{\theta}}_{2}}} \right\} \\ \; \\ {{{{}_{}^{}{x¨}_{}^{}}S\; \theta_{2}} - {{{}_{}^{}{y¨}_{}^{}}{S\left( {\beta - \theta_{1}} \right)}C\; \theta_{2}} + {{{}_{}^{}{z¨}_{}^{}}{C\left( {\beta + \theta_{1}} \right)}C\; \theta_{2}}} \\ {+ {L_{Sk\_ com}\left\lbrack {{\overset{.}{\theta}}_{2}^{2} + {\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)^{2}\mspace{14mu} C^{2}\theta_{2}}} \right\rbrack}} \end{bmatrix}} & (39) \end{matrix}$

Similarly, from (19), (24), and (31), COM of foot position with respect to the world frame can be obtained as follows:

$\begin{matrix} {{{}_{}^{}{}_{}^{}} = {{{{}_{}^{}{}_{}^{}} + {{{}_{}^{}{}_{}^{}}P_{Ft}}} = \begin{bmatrix} {{{}_{}^{}{}_{}^{}} + {{}_{}^{}{}_{}^{}}} \\ {{{{}_{}^{}{}_{}^{}}C\; \beta} - {{{}_{}^{}{}_{}^{}}S\; \beta} + {{}_{}^{}{}_{}^{}}} \\ {{{{}_{}^{}{}_{}^{}}S\; \beta} + {{{}_{}^{}{}_{}^{}}C\; \beta} + {{}_{}^{}{}_{}^{}}} \end{bmatrix}}} & (40) \end{matrix}$

Thus, from (40), one can get acceleration of COM of foot with respect to the ankle frame.

$\begin{matrix} {{{}_{}^{}{}_{}^{}} = \begin{bmatrix} {{}_{}^{}{x¨}_{}^{}} \\ {{{{}_{}^{}{y¨}_{}^{}}C\; \beta} + {{{}_{}^{}{z¨}_{}^{}}S\; \beta} - {{\overset{.}{\beta}}^{2}\mspace{14mu} {{}_{}^{}{}_{}^{}}} - {{\overset{¨}{\beta}}^{a}z_{Ft}}} \\ {{{- {{}_{}^{}{y¨}_{}^{}}}S\; \beta} + {{{}_{}^{}{z¨}_{}^{}}C\; \beta} + {{\overset{¨}{\beta}}^{a}y_{Ft}} - {{\overset{.}{\beta}}^{2}\mspace{14mu} {{}_{}^{}{}_{}^{}}}} \end{bmatrix}} & (41) \end{matrix}$

Because are ^(a)P_(Ft)=[^(a)x_(Ft) ^(a)y_(Ft) ^(a)z_(Ft)]^(T) is a constant vector, ^(a){dot over (x)}_(Ft), ^(a){dot over (y)}_(Ft), ^(a)ż_(Ft), and ^(a){umlaut over (x)}_(Ft), ^(a)ÿ_(Ft), ^(a){umlaut over (z)}_(Ft) are not shown in (41). Note that the aim of this derivation is to compute the knee and ankle moments and forces.

From FIG. 2( c), 6 DOF equation of motion of shank with respect to knee frame can be written as follows:

m _(Sk) ^(k) a _(Sk)=−^(k) F _(a)+^(k) F _(k) +m _(Sk) ^(k) g  (42)

and

^(k) I _(Sk) ^(k){umlaut over (θ)}_(Sk)+^(k){dot over (θ)}_(Sk)×^(k) I _(Sk) ^(k){dot over (θ)}_(Sk)=(^(k) P _(a)−^(k) P _(Sh))×(−^(k) F _(a))+(^(k) P _(k)−^(k) P _(Sh))×^(k) F _(k)−^(k) M _(a)+^(k) M _(k)  (43)

(43) is written with respect to the knee frame, however, in (43), ^(k)I_(Sk) denotes the inertia matrix of shank about its COM, and the moment arms (^(k)P_(a)−^(k)P_(Sh)), and (^(k)P_(k)−^(k)P_(Sh)) are the vectors from COM of shank to ankle, and to knee, respectively. Thus, (43) can be regarded as the equation of rotational motion of shank with respect to the COM of shank frame—a frame which has the same orientation of the knee frame but its origin is located at COM of shank.

Similarly, from FIG. 2( b), 6 DOF equation of motion of foot with respect to the ankle frame can be obtained.

m _(Ft) ^(a) a _(Ft)=^(a) F _(F/T)+^(a) F _(a) +m _(Ft) ^(a) g  (44)

^(a) I _(Ft) ^(a){umlaut over (θ)}_(Ft)=(^(a) P _(F/T)−^(a) P _(Ft))×^(a) F _(F/T)+(^(a) P _(a)−^(a) P _(Ft))×^(a) F _(a)+^(a) M _(F/T)+^(a) M _(a)  (45)

Similar to (43), (45) is written with respect to ankle frame, however, in (45), ^(a)I_(Ft) denotes the inertia matrix of foot about its COM, and the moment arms (^(a)P_(F/T)−^(a)P_(Ft)), and (^(a)P_(a)−^(a)P_(Ft)) are the vectors from COM of foot to center of 6-axis F/T sensor, and to ankle, respectively. Thus, (45) can be regarded as the equation of rotational motion with respect to the COM of foot frame—a frame which has the same orientation of ankle frame but its origin is located at COM of foot. Further, because ^(a){dot over (θ)}_(Ft)=[{dot over (β)} 0 0]^(T), ^(a){dot over (θ)}_(Ft)+^(a)I_(Ft) ^(a){dot over (θ)}_(Ft) is always a zero vector². Thus it is omitted from left-hand-side of (45). ²We assumed that foot inertia matrix is a diagonal matrix.

Solving (43) for ^(k)M_(k), we have

^(k) M _(k)=^(k) I _(Sk) ^(k){umlaut over (θ)}_(Sk)+^(k){dot over (θ)}_(Sk)×^(k) I _(Sk) ^(k){dot over (θ)}_(Sk)−(^(k) P _(a)−_(k) P _(Sh))×(−^(k) F _(a))−(^(k) P _(k)−^(k) P _(Sh))×^(k) F _(k)+^(k) M _(a)  (46)

Substituting (20), (22), (23), and (29) into (46) and rearranging it yields

$\begin{matrix} {\begin{bmatrix} {{}_{}^{}{}_{}^{}} \\ {{}_{}^{}{}_{}^{}} \\ {{}_{}^{}{}_{}^{}} \end{bmatrix} = {\begin{bmatrix} {{{}_{}^{}{}_{}^{}}{{}_{}^{}{\theta ¨}_{}^{}}} \\ {{{}_{}^{}{}_{}^{}}{{}_{}^{}{\theta ¨}_{}^{}}} \\ {{{}_{}^{}{}_{}^{}}{{}_{}^{}{\theta ¨}_{}^{}}} \end{bmatrix} + \mspace{59mu} \begin{bmatrix} {\left( {{{}_{}^{}{}_{}^{}} - {{}_{}^{}{}_{}^{}}} \right)\left\{ {{\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)\left\lbrack {{{- \left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)}S\; \theta_{2}C\; \theta_{2}S\; \theta_{3}} + \left( {{{\overset{.}{\theta}}_{2}S\; \theta_{2}C\; \theta_{3}} - {{\overset{.}{\theta}}_{3}C\; \theta_{2}S\; \theta_{3}}} \right)} \right\rbrack} + {{\overset{.}{\theta}}_{2}{\overset{.}{\theta}}_{3}C\; \theta_{3}}} \right\}} \\ {{\,\left( {{{}_{}^{}{}_{}^{}} - {{}_{}^{}{}_{}^{}}} \right)}\left\{ {{\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)\left\lbrack {{\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)S\; \theta_{2}C\; \theta_{2}C\; \theta_{3}} + \left( {{{\overset{.}{\theta}}_{2}S\; \theta_{2}S\; \theta_{3}} + {{\overset{.}{\theta}}_{3}C\; \theta_{2}C\; \theta_{3}}} \right)} \right\rbrack} + {{\overset{.}{\theta}}_{2}{\overset{.}{\theta}}_{3}S\; \theta_{3}}} \right\}} \\ {\left( {{{}_{}^{}{}_{}^{}} - {{}_{}^{}{}_{}^{}}} \right)\left\lbrack {{{\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)\left\lbrack {{{- \left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)}C\; \theta_{2}S\; \theta_{3}C\; \theta_{3}} + {{\overset{.}{\theta}}_{2}{C\left( {2\; \theta_{3}} \right)}}} \right\rbrack}C\; \theta_{2}} + {{\overset{.}{\theta}}_{2}^{2}S\; \theta_{3}C\; \theta_{3}}} \right\rbrack} \end{bmatrix} + \mspace{506mu} \begin{bmatrix} {\left( {L_{Sk} - L_{Sk\_ com}} \right)^{k}F_{ay}} \\ {{- \left( {L_{Sk} - L_{Sk\_ com}} \right)^{k}}F_{ax}} \\ 0 \end{bmatrix} + \begin{bmatrix} {L_{Sk\_ com}\mspace{14mu} {{}_{}^{}{}_{}^{}}} \\ {{- L_{Sk\_ com}}\mspace{14mu} {{}_{}^{}{}_{}^{}}} \\ 0 \end{bmatrix} + \begin{bmatrix} {{}_{}^{}{}_{}^{}} \\ {{}_{}^{}{}_{}^{}} \\ {{}_{}^{}{}_{}^{}} \end{bmatrix}}} & (47) \end{matrix}$

From (47), one can have the following expression of ^(k)M_(k)

$\begin{matrix} \left\{ \begin{matrix} {{{}_{}^{}{}_{}^{}} = {{{{}_{}^{}{}_{}^{}}{{}_{}^{}{\theta ¨}_{}^{}}} + {{}_{}^{}{}_{}^{}}}} \\ {{+ \left( {{{}_{}^{}{}_{}^{}} - {{}_{}^{}{}_{}^{}}} \right)}\left\{ {{\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)\left\lbrack {{{- \left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)}S\; \theta_{2}C\; \theta_{2}S\; \theta_{3}} + \left( {{{\overset{.}{\theta}}_{2}S\; \theta_{2}C\; \theta_{3}} - {{\overset{.}{\theta}}_{3}C\; \theta_{2}S\; \theta_{3}}} \right)} \right\rbrack} + {{\overset{.}{\theta}}_{2}{\overset{.}{\theta}}_{3}C\; \theta_{3}}} \right\}} \\ {{{+ \left( {L_{Sk} - L_{Sk\_ com}} \right)^{k}}F_{ay}} + {L_{Sk\_ com}\mspace{14mu} {{}_{}^{}{}_{}^{}}}} \\ {{{{}_{}^{}{}_{}^{}} = {{{{}_{}^{}{}_{}^{}}{{}_{}^{}{\theta ¨}_{}^{}}} + {{}_{}^{}{}_{}^{}}}}\mspace{14mu}} \\ {{+ \left( {{{}_{}^{}{}_{}^{}} - {{}_{}^{}{}_{}^{}}} \right)}\left\{ {{\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)\left\lbrack {{\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)S\; \theta_{2}C\; \theta_{2}C\; \theta_{3}} + \left( {{{\overset{.}{\theta}}_{2}S\; \theta_{2}S\; \theta_{3}} + {{\overset{.}{\theta}}_{3}C\; \theta_{2}C\; \theta_{3}}} \right)} \right\rbrack} + {{\overset{.}{\theta}}_{2}{\overset{.}{\theta}}_{3}S\; \theta_{3}}} \right\}} \\ {{{- \left( {L_{Sk} - L_{Sk\_ com}} \right)^{k}}F_{ax}} - {L_{Sk\_ com}\mspace{14mu} {{}_{}^{}{}_{}^{}}}} \\ {{{}_{}^{}{}_{}^{}} = {{{{}_{}^{}{}_{}^{}}\mspace{14mu} {{}_{}^{}{\theta ¨}_{}^{}}} + {{}_{}^{}{}_{}^{}}}} \\ {+ {\left( {{{}_{}^{}{}_{}^{}} - {{}_{}^{}{}_{}^{}}} \right)\left\lbrack {{{\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)\left\lbrack {{{- \left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)}C\; \theta_{2}S\; \theta_{3}C\; \theta_{3}} + {{\overset{.}{\theta}}_{2}{C\left( {2\; \theta_{3}} \right)}}} \right\rbrack}C\; \theta_{2}} + {{\overset{.}{\theta}}_{2}^{2}S\; \theta_{3}C\; \theta_{3}}} \right\rbrack}} \end{matrix} \right. & (48) \end{matrix}$

Substituting (30) into (48) yields

^(k) M _(kx)=^(k) I _(Sk) _(—) _(x)[({umlaut over (θ)}₁+{umlaut over (β)})Cθ ₂ Cθ ₃+{umlaut over (θ)}₂ Sθ ₃−({dot over (θ)}₁+{dot over (β)})({dot over (θ)}₂ Sθ ₂ Cθ ₃+{dot over (θ)}₃ Cθ ₂ Sθ ₃)+{dot over (θ)}₂{dot over (θ)}₃ Sθ ₃]

+(^(k) I _(Sk) _(—) _(z)−^(k) I _(Sk) _(—) _(y)){({dot over (θ)}₁+{dot over (β)})[−({dot over (θ)}₁+{dot over (β)})Sθ ₂ Cθ ₂ Sθ ₃+({dot over (θ)}₂ Sθ ₂ Cθ ₃−{dot over (θ)}₃ Cθ ₂ Sθ ₃)]+{dot over (θ)}₂{dot over (θ)}₃ Cθ ₃}

+(L _(Sk) −L _(Sk) _(—) _(com))^(k) F _(ay) +L _(Sk) _(—) _(com) ^(k) F _(ky)+^(k) M _(ax)

^(k) M _(ky)=^(k) I _(Sk) _(—) _(y)[({umlaut over (θ)}₁+{umlaut over (β)})Cθ ₂ Sθ ₃+{umlaut over (θ)}₂ Cθ ₃−({dot over (θ)}₁+{dot over (β)})({dot over (θ)}₂ Sθ ₂ Sθ ₃−{dot over (θ)}₃ Cθ ₂ Cθ ₃)−{dot over (θ)}₂{dot over (θ)}₃ Sθ ₃]

+(^(k) I _(Sk) _(—) _(x)−^(k) I _(Sk) _(—) _(z)){({dot over (θ)}₁+{dot over (β)})[({dot over (θ)}₁+{dot over (β)})Sθ ₂ Cθ ₂ Cθ ₃+({dot over (θ)}₂ Sθ ₂ Sθ ₃+{dot over (θ)}₃ Cθ ₂ Cθ ₃)]+{dot over (θ)}₂{dot over (θ)}₃ Sθ ₃}

−(L _(Sk) −L _(Sk) _(—) _(com))^(k) F _(ax) −L _(Sk) _(—) _(com) ^(k) F _(kx)+^(k) M _(ay)

^(k) M _(kz)=^(k) I _(Sk) _(—) _(z)[({umlaut over (θ)}₁+{umlaut over (β)})Sθ ₂+{umlaut over (θ)}₃+({dot over (θ)}₁+{dot over (β)}){dot over (θ)}₂ Cθ ₂]+^(k) M _(az)+

(^(k) I _(Sk) _(—) _(y)−^(k) I _(Sk) _(—) _(x))[({dot over (θ)}₁+{dot over (β)})[−({dot over (θ)}₁+{dot over (β)})Cθ ₂ Sθ ₃ Cθ ₃+{dot over (θ)}₂ C(2θ₃)]Cθ ₂+{dot over (θ)}₂ ² Sθ ₃ Cθ ₃]  (49)

Substituting (37) into (42) and solving for ^(k)F_(k), we have

$\begin{matrix} {{{}_{}^{}{}_{}^{}} = \begin{bmatrix} {{m_{Sk}\left\{ {{{}_{}^{}{}_{}^{}} + {g\left\lbrack {{{- {C\left( {\beta - \theta_{1}} \right)}}S\; \theta_{2}C\; \theta_{3}} + {{S\left( {\beta + \theta_{1}} \right)}S\; \theta_{3}}} \right\rbrack}} \right\}} + {{}_{}^{}{}_{}^{}}} \\ {{m_{Sk}\left\{ {{{}_{}^{}{}_{}^{}} + {g\left\lbrack {{{C\left( {\beta + \theta_{1}} \right)}S\; \theta_{2}S\; \theta_{3}} + {{S\left( {\beta + \theta_{1}} \right)}C\; \theta_{3}}} \right\rbrack}} \right\}} + {{}_{}^{}{}_{}^{}}} \\ {{m_{Sk}\left\{ {{{}_{}^{}{}_{}^{}} + {{{gC}\left( {\beta + \theta_{1}} \right)}C\; \theta_{2}}} \right\}} + {{}_{}^{}{}_{}^{}}} \end{bmatrix}} & (50) \end{matrix}$

Substituting (50) into (49), one can rewrite (49) as follows:

$\begin{matrix} \left\{ \begin{matrix} {{{}_{}^{}{}_{}^{}} = {{{}_{}^{}{}_{}^{}}\left\lbrack {{\left( {{\overset{¨}{\theta}}_{1} + \overset{¨}{\beta}} \right)C\; \theta_{2}C\; \theta_{3}} + {{\overset{¨}{\theta}}_{2}S\; \theta_{3}} - {\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)\left( {{{\overset{.}{\theta}}_{2}S\; \theta_{2}C\; \theta_{3}} + {{\overset{.}{\theta}}_{3}C\; \theta_{2}S\; \theta_{3}}} \right)} + {{\overset{.}{\theta}}_{2}{\overset{.}{\theta}}_{3}S\; \theta_{3}}} \right\rbrack}} \\ {{+ \left( {{{}_{}^{}{}_{}^{}} - {{}_{}^{}{}_{}^{}}} \right)}\left\{ {{\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)\left\lbrack {{{- \left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)}S\; \theta_{2}C\; \theta_{2}S\; \theta_{3}} + \left( {{{\overset{.}{\theta}}_{2}S\; \theta_{2}C\; \theta_{3}} - {{\overset{.}{\theta}}_{3}C\; \theta_{2}S\; \theta_{3}}} \right)} \right\rbrack} + {{\overset{.}{\theta}}_{2}{\overset{.}{\theta}}_{3}C\; \theta_{3}}} \right\}} \\ {{{+ L_{Sk\_ com}}n_{Sk}\left\{ {{{}_{}^{}{}_{}^{}} + {g\left\lbrack {{{C\left( {\beta + \theta_{1}} \right)}S\; \theta_{2}S\; \theta_{3}} + {{S\left( {\beta + \theta_{1}} \right)}C\; \theta_{3}}} \right\rbrack}} \right\}} + {L_{Sk}\mspace{14mu} {{}_{}^{}{}_{}^{}}} + {{}_{}^{}{}_{}^{}}} \\ \; \\ {{{}_{}^{}{}_{}^{}} = {{{}_{}^{}{}_{}^{}}\left\lbrack {{{- \left( {{\overset{¨}{\theta}}_{1} + \overset{¨}{\beta}} \right)}C\; \theta_{2}S\; \theta_{3}} + {{\overset{¨}{\theta}}_{2}C\; \theta_{3}} + {\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)\left( {{{\overset{.}{\theta}}_{2}S\; \theta_{2}S\; \theta_{3}} - {{\overset{.}{\theta}}_{3}C\; \theta_{2}C\; \theta_{3}}} \right)} - {{\overset{.}{\theta}}_{2}{\overset{.}{\theta}}_{3}S\; \theta_{3}}} \right\rbrack}} \\ {{+ \left( {{{}_{}^{}{}_{}^{}} - {{}_{}^{}{}_{}^{}}} \right)}\left\{ {{\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)\left\lbrack {{\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)S\; \theta_{2}C\; \theta_{2}C\; \theta_{3}} + \left( {{{\overset{.}{\theta}}_{2}S\; \theta_{2}S\; \theta_{3}} + {{\overset{.}{\theta}}_{3}C\; \theta_{2}C\; \theta_{3}}} \right)} \right\rbrack} + {{\overset{.}{\theta}}_{2}{\overset{.}{\theta}}_{3}S\; \theta_{3}}} \right\}} \\ {{{- L_{Sk\_ com}}m_{Sk}\left\{ {{{}_{}^{}{}_{}^{}} + {g\left\lbrack {{{- {C\left( {\beta + \theta_{1}} \right)}}S\; \theta_{2}C\; \theta_{3}} + {{S\left( {\beta + \theta_{1}} \right)}S\; \theta_{3}}} \right\rbrack}} \right\}} - {L_{Sk}\mspace{14mu} {{}_{}^{}{}_{}^{}}} + {{}_{}^{}{}_{}^{}}} \\ \; \\ {{{}_{}^{}{}_{}^{}} = {{{}_{}^{}{}_{}^{}}\left\lbrack {{\left( {{\overset{¨}{\theta}}_{1} + \overset{¨}{\beta}} \right)S\; \theta_{2}} + {\overset{¨}{\theta}}_{3} + {\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right){\overset{.}{\theta}}_{2}C\; \theta_{2}}} \right\rbrack}} \\ {+ {\left( {{{}_{}^{}{}_{}^{}} - {{}_{}^{}{}_{}^{}}} \right)\left\lbrack {{{\left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)\left\lbrack {{{- \left( {{\overset{.}{\theta}}_{1} + \overset{.}{\beta}} \right)}C\; \theta_{2}S\; \theta_{3}C\; \theta_{3}} + {{\overset{.}{\theta}}_{2}{C\left( {2\; \theta_{3}} \right)}}} \right\rbrack}C\; \theta_{2}} + {{\overset{.}{\theta}}_{2}^{2}S\; \theta_{3}C\; \theta_{3}}} \right\rbrack}} \\ {+ {{}_{}^{}{}_{}^{}}} \end{matrix} \right. & (51) \end{matrix}$

Solving (44) for ^(a)F_(a) yields

^(a) F _(a) =m _(Ft) ^(a) a _(Ft)−^(a) F _(F/T) −m _(Ft) ^(a) g  (52)

Substituting (36) and (41) into (52), we have

$\begin{matrix} {\begin{bmatrix} {{}_{}^{}{}_{}^{}} \\ {{}_{}^{}{}_{}^{}} \\ {{}_{}^{}{}_{}^{}} \end{bmatrix} = \begin{bmatrix} {{m_{Ft}{{}_{}^{}{x¨}_{}^{}}} - {{}_{}^{}{}_{F\text{/}{T\_ x}}^{}}} \\ {{m_{Ft}\left( {{{{}_{}^{}{y¨}_{}^{}}C\; \beta} + {{{}_{}^{}{z¨}_{}^{}}S\; \beta} - {{\overset{.}{\beta}}^{2}\mspace{14mu} {{}_{}^{}{}_{}^{}}} - {{\overset{¨}{\beta}}^{a}z_{Ft}}} \right)} - {{}_{}^{}{}_{F\text{/}{T\_ y}}^{}} + {m_{Ft}{gS}\; \beta}} \\ {{m_{Ft}\left( {{{- {{}_{}^{}{y¨}_{}^{}}}S\; \beta} + {{{}_{}^{}{z¨}_{}^{}}C\; \beta} + {{\overset{¨}{\beta}}^{a}y_{Ft}} - {{\overset{.}{\beta}}^{2}\mspace{14mu} {{}_{}^{}{}_{}^{}}}} \right)} - {{}_{}^{}{}_{F\text{/}{T\_ z}}^{}} + {m_{Ft}{gC}\; \beta}} \end{bmatrix}} & (53) \end{matrix}$

Solving (45) for ^(a)M_(a) yields

^(a) M _(a)=^(a) I _(Ft) ^(a){umlaut over (θ)}_(Ft)−(^(a) P _(F/T)−^(a) P _(Ft))×^(a) F _(F/T)−(^(a) P _(a)−^(a) P _(Ft))×^(a) F _(a)−^(a) M _(F/T)  (54)

Substituting (20), (24)-(28), and (53) into (54) and rearranging it yield

^(a) M _(ax)=^(a) F _(F/T) _(—) _(y) ^(a) z _(F/T)−^(a) F _(F/T) _(—) _(z) ^(a) y _(F/T)−^(a) M _(F/T) _(—) _(x)

+m _(Ft)[−(^(a) y _(Ft) Sβ+ ^(a) z _(Ft) Cβ)^(o) ÿ _(a)+(^(a) y _(Ft) Cα− ^(a) z _(Ft) Sβ)(^(o) {umlaut over (z)} _(a) +g)]

+[^(a) I _(Ft) _(—) _(z) +m _(Ft)(^(a) y _(Ft) ²+^(a) z _(Ft) ²)]{umlaut over (β)}  (55)

^(a) M _(ay)=^(a) F _(F/T) _(—) _(x) ^(a) z _(F/T)+^(a) F _(F/T) _(—) _(z) ^(a) x _(F/T)−^(a) M _(F/T) _(—) _(y)

+m _(Ft){^(a) z _(Ft) ^(o) {umlaut over (x)} _(a)+^(a) x _(Ft) Sβ ^(o) ÿ _(a)−^(a) x _(Ft) Cβ(^(o) {umlaut over (z)} _(a) +g)−^(a) x _(Ft) ^(a) y _(Ft){umlaut over (β)}+^(a) x _(Ft) ^(a) z _(Ft){dot over (β)}²}(56)

and

^(a) M _(az)=^(a) F _(F/T) _(—) _(x) ^(a) y _(F/T)−^(a) F _(F/T) _(—) _(y) ^(a) x _(F/T)−^(a) M _(F/T) _(—) _(z)

+m _(Ft){^(a) x _(Ft) Cβ ^(o) ÿ _(a)+^(a) x _(Ft) Sβ(^(o) {umlaut over (z)} _(a) +g)−^(a) x _(Ft) ^(a) z _(Ft){umlaut over (β)}−^(a) x _(Ft) ^(a) y _(Ft){dot over (β)}²}  (57)

By multiplying rotation matrix _(a) ^(k)R, given in (33), on both side of (53) and ^(a)M_(a), elements of which are given in (55), (56), and (57), one can get ^(k)F_(a) and ^(k)M_(a) as follows:

^(k) F _(ax)=−^(a) F _(F/T) _(—) _(x) Cθ ₂ Cθ ₃−^(a) F _(F/T) _(—) _(y)(Sθ ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)+^(a) F _(F/T) _(—) _(z)(Cθ ₁ Sθ ₂ Cθ ₃ −Sθ ₁ Sθ ₃

+m _(Ft) {Cθ ₂ Cθ ₃ ^(o) {umlaut over (x)} _(a) +[S(β+θ₁)Sθ ₂ Cθ ₃ +C(β+θ₁)Sθ ₃]_(o) ÿ _(a)

+[−C(β+θ₁)Sθ ₂ Cθ ₃ +S(β+θ₁)Sθ ₃](^(o) {umlaut over (z)} _(a) +g)

+[−Sθ ₂ Cθ ₃(^(a) y _(Ft) Cθ ₁+^(a) z _(Ft) Sθ ₁)+(^(a) y _(Ft) Sθ ₁−^(a) z _(Ft) Cθ ₁)Sθ ₃]{umlaut over (β)}

+[Sθ ₂ Cθ ₃(−_(a) y _(Ft) Sθ ₁+^(a) z _(Ft) Cθ ₁)−Sθ ₃(^(a) y _(Ft) Cθ ₁+^(a) z _(Ft) Sθ ₁)]{dot over (β)}²}  (58)

^(k) F _(ay)=^(a) F _(F/T) _(—) _(x) Cθ ₂ Sθ ₃+^(a) F _(F/T) _(—) _(y)(Sθ ₁ Sθ ₂ Sθ ₃ −Cθ ₁ Cθ ₃)−^(a) F _(F/T) _(—) _(z)(Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)

m _(Ft){[−(^(a) y _(Ft) Cθ ₁+^(a) z _(Ft) Sθ ₁)Cθ ₃+(^(a) y _(Ft) Sθ ₁−^(a) z _(Ft) Cθ ₁)Sθ ₂ Sθ ₃]{dot over (β)}²

+[(^(a) z _(Ft) Sθ ₁+^(a) y _(Ft) Cθ ₁)Sθ ₂ Sθ ₃+(^(a) y _(Ft) Sθ ₁−^(a) z _(Ft) Cθ ₁)Cθ ₃]{umlaut over (β)}

−^(o) {umlaut over (x)} _(a) Cθ ₂ Sθ ₃ +[−S(β+θ₁)Sθ ₂ Sθ ₃ +C(β+θ₁)Cθ ₃]^(o) ÿ _(a)

+[C(β+θ₁)Sθ ₂ Sθ ₃ +S(β+θ₁)Cθ ₃](^(o) {umlaut over (z)} _(a) +g)}  (59)

^(k) F _(az)=^(a) F _(F/T) _(—) _(x) Sθ ₂+^(a) F _(F/T) _(—) _(y) Sθ ₁ Cθ ₂−^(a) F _(F/T) _(—) _(z) Cθ ₁ Cθ ₂

+m _(Ft) {+Sθ ₂ ^(o) {umlaut over (x)} _(a) −S(β+θ₁)Cθ ₂ ^(o) ÿ _(a) +C(β+θ₁)Cθ ₂(^(o) {umlaut over (z)} _(a) +g)

+(^(a) y _(Ft) Cθ ₁+^(a) z _(Ft) Sθ ₁)Cθ ₂{umlaut over (β)}+(^(a) y _(Ft) Sθ ₁−^(a) z _(Ft) Cθ ₁)Cθ ₂{dot over (β)}²}  (60)

^(k) M _(ax)=(^(a) I _(Ft) _(—) _(x){umlaut over (β)}−^(a) M _(F/T) _(—) _(x))Cθ ₂ Cθ ₃

−^(a) M _(F/T) _(—) _(y)(Sθ ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)−^(a) M _(F/T) _(—) _(z)(Cθ ₁ Sθ ₂ Cθ ₃ −Sθ ₁ Sθ ₃)

−^(a) F _(F/T) _(—) _(x)[^(a) y _(F/T)(Cθ ₁ Sθ ₂ Cθ ₃ −Sθ ₁ Sθ ₃)+^(a) z _(F/T)(Sθ ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)]

+^(a) F _(F/T) _(—) _(y)[^(a) y _(F/T)(Cθ ₁ Sθ ₂ Cθ ₃ −Sθ ₁ Sθ ₃)+^(a) z _(F/T) Cθ ₂ Cθ ₃]

+^(a) F _(F/T) _(—) _(z)[^(a) x _(F/T)(Sθ ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)−^(a) y _(F/T) Cθ ₂ Cθ ₃]

+m _(Ft) ^(o) {umlaut over (x)} _(a)[^(a) y _(Ft)(Cθ ₁ Sθ ₂ Cθ ₃ −Sθ ₁ Sθ ₃)+^(a) z _(Ft)(Sθ ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)]

+m _(Ft) ^(o) ÿ _(a){^(a) x _(Ft) [−C(β+θ₁)Sθ ₁ Cθ ₃ +S(β+θ₁)Sθ ₃]−(^(a) y _(Ft) Sβ+ ^(a) z _(Ft) Cβ)Cθ ₂ Cθ ₃}

−m _(Ft)(^(o) {umlaut over (z)}+g){^(a) x _(Ft) [S(β+θ₁)Sθ ₂ Cθ ₃ +C(β+θ₁)Sθ ₃]−(^(a) y _(Ft) Cβ− ^(a) z _(Ft) Sβ)Cθ ₂ Cθ ₃}

−m _(Ft){umlaut over (β)}{^(a) x _(Ft)[^(a) y _(Ft)(Sθ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)+^(a) z _(Ft)(−Cθ ₁ Sθ ₂ Cθ ₃ +Sθ ₁ Sθ ₃)]

−(^(a) y _(Ft) ²+^(a) z _(Ft) ²)Cθ ₂ Cθ ₃}

+m _(Ft){dot over (β)}^(2a) x _(Ft)[^(a) y _(Ft)(Cθ ₁ Sθ ₂ Cθ ₃ −Sθ ₁ Sθ ₃)+^(a) z _(Ft)(Sθ ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)]  (61)

^(k) M _(ay)=−(^(a) I _(Ft) _(—) _(x){umlaut over (β)}−^(a) M _(F/T) _(—) _(x))Cθ ₂ Sθ ₃−^(a) M _(F/T) _(—) _(y)(−Sθ ₁ Sθ ₂ Sθ ₃ +Cθ ₁ Cθ ₃)

−_(a) M _(F/T) _(—) _(z)(Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)

+^(a) F _(F/T) _(—) _(x)[^(a) y _(F/T)(Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)−^(a) z _(F/T)(−Sθ ₁ Sθ ₂ Sθ ₃ +Cθ ₁ Cθ ₃)]

−F _(F/T) _(—) _(y)[^(a) x _(F/T)(−Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)+^(a) z _(F/T) Cθ ₂ Sθ ₃]

+^(a) F _(F/T) _(—) _(z)[^(a) x _(F/T)(−Sθ ₁ Sθ ₂ Sθ ₃ +Cθ ₁ Cθ ₃)+^(a) y _(F/T) Cθ ₂ Sθ ₃]

−m _(Ft) ^(o) {umlaut over (x)} _(a)[^(a) y _(Ft)(Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)−^(a) z _(Ft)(−Sθ ₁ Sθ ₂ Sθ ₃ +Cθ ₁ Cθ ₃)]

+m _(Ft) ^(o) ÿ _(a){^(a) x _(Ft) [C(β+θ₁)Sθ ₂ Sθ ₃ +S(β+θ₁)Cθ ₃]+(^(a) y _(Ft) Sβ+ ^(a) z _(Ft) Cβ)Cθ ₂ Sθ ₃}

−m _(Ft)(^(o) {umlaut over (z)} _(a) +g){^(a) x _(Ft) [−S(β+θ₁)Sθ ₂ Sθ ₃ +C(β+θ₁)Cθ ₃]+(^(a) y _(Ft) Cβ− ^(a) z _(Ft) Sβ)Cθ ₂ Sθ ₃}

−m _(Ft){umlaut over (β)}{(^(a) x _(Ft)[^(a) y _(Ft)(−Sθ ₁ Sθ ₂ Sθ ₃ +Cθ ₁ Cθ ₃)+^(a) z _(Ft)(Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)]

+(^(a) y _(Ft) ²+^(a) z _(Ft) ²)Cθ ₂ Sθ ₃}

−m _(Ft){dot over (β)}^(2a) x _(Ft)[^(a) y _(Ft)(Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)−^(a) z _(Ft)(−Sθ ₁ Sθ ₂ Sθ ₃ +Cθ ₁ Cθ ₃)]  (62)

^(k) M _(az)=(^(a) I _(Ft) _(—) _(x){umlaut over (β)}−^(a) M _(F/T) _(—) _(x))Sθ ₂+(^(a) M _(F/T) _(—) _(y) Sθ ₁−^(a) M _(F/T) _(—) _(z))Cθ ₁ Cθ ₂

+^(a) F _(F/T) _(—) _(x)(^(a) y _(F/T) Cθ ₁+^(a) z _(F/T) Sθ ₁)Cθ ₂−^(a) F _(F/T) _(—) _(y)(^(a) x _(F/T) Cθ ₁ Cθ ₂−^(a) z _(F/T) Sθ ₂)

−^(a) F _(F/T) _(—) _(z))(^(a) x _(F/T) Sθ ₁ Cθ ₂+^(a) y _(F/T) Sθ ₂)

−m _(Ft) ^(o) {umlaut over (x)} _(a)(^(a) y _(Ft) Cθ ₁+^(a) z _(Ft) Sθ ₁)Cθ ₂ −m _(Ft) ^(o) ÿ _(a)[^(a) x _(Ft) C(β+θ₁)Cθ ₂+(^(a) y _(Ft) Sβ+ ^(a) z _(Ft) Cβ)Sθ ₂]

+m _(Ft)(^(o) {umlaut over (z)} _(a) +g)[^(a) x _(Ft) S(β+θ₁)Cθ ₂+(^(a) y _(Ft) Cβ− ^(a) z _(Ft) Sβ)Sθ ₂]

+m _(Ft){umlaut over (β)}[(^(a) y _(Ft) ²+^(a) z _(Ft) ²)Sθ ₂+^(a) x _(Ft)(^(a) y _(Ft) Sθ ₁ Cθ ₂−^(a) z _(Ft) Cθ ₁ Cθ ₂)]

−m _(Ft){dot over (β)}^(2a) x _(Ft)(^(a) y _(Ft) Cθ ₁+^(a) z _(Ft) Sθ ₁)Cθ ₂  (63)

Substituting (39), (58), (59) and (60) into (50), one can rewrite (50) as follows:

^(k) F _(kx)=−^(a) F _(F/T) _(—) _(x) Cθ ₂ Cθ ₃−^(a) F _(F/T) _(—) _(y)(Sθ ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)+F _(F/T) _(—) _(z)(Cθ ₁ Sθ ₂ Sθ ₃−Sθ₃ Sθ ₃)

+(m _(Sk) +m _(Ft))Cθ ₂ Cθ ₃ ^(o) {umlaut over (x)} _(a)+(m _(Sk) +m _(Ft))[S(β+θ₁)Sθ ₂ Cθ ₃ +C(β+θ₁)Sθ ₃]^(o) ÿ _(a)

−(m _(Sk) +m _(Ft))[C(β+θ₁)Sθ ₂ Cθ ₃ −S(β+θ₁)Sθ ₃](^(o) {umlaut over (z)} _(a) +g)

−m _(Ft){umlaut over (β)}[^(a) y _(Ft)(Cθ ₁ Sθ ₂ Cθ ₃ −Sθ ₁ Sθ ₃)+^(a) z _(Ft)(Sθ ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)]

+m _(Sk) L _(Sk) _(—) _(com) {Cθ ₂ Sθ ₃({umlaut over (θ)}₁+{umlaut over (β)})−Cθ ₃{umlaut over (θ)}₂ −Sθ _(2[)2Sθ ₃({dot over (θ)}₁+{dot over (β)}){dot over (θ)}₂ +Cθ ₂ Cθ ₃({dot over (θ)}₁+{dot over (β)})²]}

−m _(Ft){dot over (β)}²[^(a) y _(Ft)(Sθ ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)−^(a) z _(Ft)(Cθ ₁ Sθ ₂ Cθ ₃−Sθ₁ Sθ ₃)]  (64)

^(k) F _(ky)=^(a) F _(F/T) _(—) _(x) Cθ ₂ Sθ ₃+^(a) F _(F/T) _(—) _(y)(Sθ ₁ Sθ ₂ Sθ ₃ −Cθ ₃ Cθ ₃)−F_(F/T) _(—) _(z)(Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)

−(m _(Sk) +m _(Ft)){Cθ ₂ Sθ ₃ ^(o) {umlaut over (x)} _(a) +[S(β+θ₁)Sθ ₂ Sθ ₃ −C(β+θ₁)Cθ ₃]^(o) ÿ _(a)}

+(m _(Sk) +m _(Ft))[C(β+θ₁)Sθ ₂ Sθ ₃ +S(β+θ₁)Cθ ₃](^(o) {umlaut over (z)} _(a) +g)+

+m _(Ft){umlaut over (β)}[^(a) y _(Ft)(Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)+^(a) z _(Ft)(Sθ ₁ Sθ ₂ Sθ ₃ −Cθ ₃ Cθ ₃)]

+m _(Sk) L _(Sk) _(—) _(com) {Cθ ₂ Cθ ₃({umlaut over (θ)}₁+{umlaut over (β)})+Sθ ₃{umlaut over (θ)}₂ +Sθ _(2[)−2Cθ ₃({dot over (θ)}₁+{dot over (β)}){dot over (θ)}₂ +Cθ ₂ Sθ ₃({dot over (θ)}₁+{dot over (β)})²]}

+m _(Ft){dot over (β)}²[^(a) y _(Ft)(Sθ ₁ Sθ ₂ Sθ ₃ −Cθ ₁ Cθ ₃)−^(a) z _(Ft)(Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)]  (65)

^(k) F _(kz)=^(a) F _(F/T) _(—) _(x) Sθ ₂+^(a) F _(F/T) _(—) _(y) Sθ ₁ Cθ ₂−^(a) F _(F/T) _(—) _(z) Cθ ₁ Cθ ₂

+(m _(Sk) +m _(Ft))[Sθ ₂ ^(o) {umlaut over (x)} _(a) −S(β+θ₁)Cθ ₂ ^(o) ÿ _(a)]+(m _(Sk) +m _(Ft))C(β+θ₁)Cθ ₂(^(o) {umlaut over (z)} _(a) +g)

+m _(Ft){umlaut over (β)}(^(a) z _(Ft) Sθ ₁+^(a) y _(Ft) Cθ ₁)Cθ ₂ +m _(Ft){dot over (β)}²(^(a) y _(Ft) Sθ ₁−^(a) z _(Ft) Cθ ₁)Cθ ₂

+m _(Sk) L _(Sk) _(—) _(com)[{umlaut over (β)}₂ ² +C ²θ₂({dot over (θ)}₁+{dot over (β)})²]  (66)

Substituting (39), (58), (59), (60), (61), (62), and (63) into (51) yields

^(k) M _(kx)=−^(a) M _(F/T) _(—) _(x) Cθ ₂ Cθ ₃−^(a) M _(F/T) _(—) _(y)(Sθ ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)+^(a) M _(F/T) _(—) _(z)(Cθ ₁ Sθ ₂ Cθ ₃ −Sθ ₁ Sθ ₃)

−^(a) F _(F/T) _(—) _(x)[^(a) y _(F/T)(Cθ ₁ Sθ ₂ Cθ ₃ −Sθ ₁ Sθ ₃)+^(a) z _(F/T)(Sθ ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)−L _(Sk) Cθ ₂ Sθ ₃]

+^(a) F _(F/T) _(—) _(y)[^(a) x _(F/T)(Cθ ₁ Sθ ₂ Cθ ₃ −Sθ ₁ Sθ ₃)+^(a) z _(F/T) Cθ ₂ Cθ ₃ +L _(Sk)(Sθ ₁ Sθ ₂ Sθ ₃ −Cθ ₁ Cθ ₃)]

+^(a) F _(F/T) _(—) _(z)[^(a) x _(F/T)(Sθ ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)−^(a) y _(F/T) Cθ ₂ Cθ ₃ −L _(Sk)(Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)]

+{−(m _(Ft) L _(Sk) +m _(Sk) L _(Sk) _(—) _(com))Cθ ₂ Sθ ₃

+m _(Ft)[^(a) y _(Ft)(Cθ ₁ Sθ ₂ Cθ ₃ −Sθ ₁ Sθ ₃)+^(a) z _(Ft)(Sθ ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)]}^(o) {umlaut over (x)} _(a)

+

(m _(Ft) L _(Sk) +m _(Sk) L _(Sk) _(—) _(com))[−S(β+θ₁)Sθ ₂ Sθ ₃ +C(β+θ₁)Cθ ₃]

+m _(Ft){^(a) x _(Ft) [−C(β+θ₁)Sθ ₂ Cθ ₃ +S(β+θ₁)Sθ ₃]−(^(a) y _(Ft) Sβ+ ^(a) z _(Ft) Cβ)Cθ ₂ Cθ ₃}

^(o) ÿ _(a)

+

(m _(Ft) L _(Sk) +m _(Sk) L _(Sk) _(—) _(com))[C(β+θ₁)Sθ ₂ Sθ ₃ +S(β+θ₁)Cθ ₃]

−m _(Ft){^(a) x _(Ft) [S(β+θ ₁)Sθ ₂ Cθ ₃ +C(β+θ₁)Sθ ₃]−(^(a) y _(Ft) Cβ− ^(a) z _(Ft) Sβ)Cθ ₂ Cθ ₃}

(^(o) {umlaut over (z)} _(a) +g)

+(^(k) I _(Sk) _(—) _(x) +m _(Sk) L _(Sk) _(—) _(com) ²)Cθ ₂ Cθ ₃({umlaut over (θ)}₁+{umlaut over (β)})+(^(k) I _(Sk) _(—) _(x) +m _(Sk) L _(Sk) _(—) _(com) ²)Sθ ₃{umlaut over (θ)}₂

+

[^(a) I _(Ft) _(—) _(x) +m _(Ft)(^(a) y _(Ft) ²+^(a) z _(Ft) ²)]Cθ ₂ Cθ ₃

+m _(Ft) {L _(Sk)[^(a) y _(Ft)(Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)+^(a) z _(Ft)(Sθ ₁ Sθ ₂ Sθ ₃ −Cθ ₁ Cθ ₃)]

−^(a) x _(Ft)[^(a) y _(Ft)(Sθ ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)+^(a) z _(Ft)(−Cθ ₁ Sθ ₂ Cθ ₃ +Sθ ₁ Sθ ₃)]}

{umlaut over (β)}

+(^(k) I _(Sk) _(—) _(y)−^(k) I _(Sk) _(—) _(z) +m _(Sk) L _(Sk) _(—) _(com) ²)Cθ ₂ Sθ ₂ Cθ ₃{dot over (θ)}₁ ²+

(^(k) I _(Sk) _(—) _(y)−^(k) I _(Sk) _(—) _(z) +m _(Sk) L _(Sk) _(—) _(com) ²)Cθ ₂ Sθ ₂ Sθ ₃

+m _(Ft) {L _(Sk)[^(a) y _(R)(Sθ ₁ Sθ ₂ Sθ ₃ −Cθ ₁ Cθ ₃)−^(a) z _(Ft)(Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)]

+^(a) x _(Ft)[^(a) y _(Ft)(Cθ ₁ Sθ ₂ Cθ ₃ −Sθ ₁ Sθ ₃)+^(a) z _(Ft)(Sθ ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)]}

{dot over (β)}²

−(^(k) I _(Sk) _(—) _(x)+^(k) I _(Sk) _(—) _(y)−^(k) I _(Sk) _(—) _(z)+2m _(Sk) L _(Sk) _(—) _(com) ²)Sθ ₂ Cθ ₃({dot over (θ)}₁+{dot over (β)}){dot over (θ)}²

+(^(k) I _(Sk) _(—) _(x)−^(k) I _(Sk) _(—) _(y)+^(k) I _(Sk) _(—) _(z))(Sθ ₂ Cθ ₃{dot over (θ)}₂ −Cθ ₂ Sθ ₃({dot over (θ)}₁+{dot over (β)})){dot over (θ)}₃

+(^(k) I _(Sk) _(—) _(y)−^(k) I _(Sk) _(—) _(z) +m _(Sk) L _(Sk) _(—) _(com) ²)S(2θ₂)Sθ ₃{dot over (θ)}₁{dot over (β)}  (67)

^(k) M _(ky)=^(a) M _(F/T) _(—) _(x) Cθ ₂ Sθ ₃+^(a) M _(F/T) _(—) _(y)(Sθ ₁ Sθ ₂ Sθ ₃ −Cθ ₁ Cθ ₃)−^(a) M _(F/T) _(—) _(z)(Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)

+^(a) F _(F/T) _(—) _(x)[^(a) y _(F/T)(Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)+^(a) z _(F/T)(Sθ ₁ Sθ ₂ Sθ ₃ −Cθ ₁ Cθ ₃)+L _(Sk) Cθ ₂ Cθ ₃]

−F _(F/T) _(—) _(y)[^(a) x _(F/T)(Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)+^(a) z _(F/T) Cθ ₂ Sθ ₃ −L _(Sk)(Sθ ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)]

+^(a) F _(F/T) _(—) _(z)[^(a) x _(F/T)(−Sθ ₁ Sθ ₂ Sθ ₃ +Cθ ₁ Cθ ₃)+^(a) y _(F/T) Cθ ₂ Sθ ₃ −L _(Sk)(Cθ ₁ Sθ ₂ Cθ ₃ −Sθ ₁ Sθ ₃)]

−{(m _(Sk) L _(Sk) _(—) _(com) +m _(Ft) L _(Sk))Cθ ₂ Cθ ₃

+m _(Ft)[^(a) y _(Ft)(Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)−^(a) z _(Ft)(−Sθ ₁ Sθ ₂ Sθ ₃ +Cθ ₁ Cθ ₃)]}^(o) {umlaut over (x)} _(a)

+

−(L _(Sk) _(—) _(com) m _(Sk) +m _(Ft) L _(Sk))[S(β+θ₁)Sθ ₂ Cθ ₃ +C(β+θ₁)Sθ ₃]

+m _(Ft){^(a) x _(Ft) [C(β+θ₁)Sθ ₂ Sθ ₃ +S(β+θ₁)Cθ ₃]+(^(a) y _(Ft) Sβ+ ^(a) z _(Ft) Cβ))Cθ ₂ Sθ ₃}

^(o) ÿ _(a)

−

(m _(Sk) L _(Sk) _(—) _(com) +m _(Ft) L _(Sk))[−C(β+θ₁)Sθ ₂ Cθ ₃ +S(β+θ₁)Sθ ₃]

+m _(Ft){^(a) x _(Ft) [−S(β+θ₁)Sθ ₂ Sθ ₃ +C(β+θ₁)Cθ ₃]+(^(a) y _(Ft) Cβ− ^(a) z _(Ft) Sβ)Cθ ₂ Sθ ₃}

(^(o) {umlaut over (z)} _(a) +g)

−[^(a) I _(Ft) _(—) _(x) +m _(Ft)(^(a) y _(Ft) ²+^(a) z _(Ft) ²)]Cθ ₂ Sθ ₃

+m _(Ft) {L _(Sk)[^(a) y _(Ft)(Cθ ₁ Sθ ₂ Cθ ₃ −Sθ ₁ Sθ ₃)+^(a) z _(Ft)(Sθ ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)]

+^(a) x _(Ft)[^(a) y _(Ft)(Sθ ₁ Sθ ₂ Sθ ₃ −Cθ ₁ Cθ ₃)−^(a) z _(Ft)(Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)]}

{umlaut over (β)}

+(^(k) I _(Sk) _(—) _(y) +m _(Sk) L _(Sk) _(—) _(com) ²)[−Cθ ₂ Sθ ₃({umlaut over (θ)}₁+{umlaut over (β)})+Cθ ₃{umlaut over (θ)}₂]

+(^(k) I _(Sk) _(—) _(x)−^(k) I _(Sk) _(—) _(z) +m _(Sk) L _(Sk) _(—) _(com) ²)Cθ ₂ Sθ ₂ Cθ ₃[({dot over (θ)}₁ ²+{dot over (β)}²)+2{dot over (θ)}₁{dot over (β)}]

+m _(Ft) {L _(Sk)[^(a) y _(Ft)(Sθ ₁ Sθ ₂ Cθ ₃ +Cθ ₁ Sθ ₃)+^(a) z _(Ft)(−Cθ ₁ Sθ ₂ Cθ ₃ +Sθ ₁ Sθ ₃)]

−^(a) x _(Ft)[^(a) y _(Ft)(Cθ ₁ Sθ ₂ Sθ ₃ +Sθ ₁ Cθ ₃)−^(a) z _(Ft)(−Sθ ₁ Sθ ₂ Sθ ₃ +Cθ ₁ Cθ ₃]}){dot over (β)}²

+(^(k) I _(Sk) _(—) _(x)−^(k) I _(Sk) _(—) _(z)+2m _(Sk) L _(Sk) _(—) _(com))Sθ ₂ Sθ ₃{dot over (θ)}₂({dot over (θ)}₁+{dot over (β)})

+(^(k) I _(Sk) _(—) _(x)−^(k) I _(Sk) _(—) _(y)−^(k) I _(Sk) _(—) _(z)){dot over (θ)}₃ [Sθ ₃{dot over (θ)}₂ +Cθ ₂ Cθ ₃({dot over (θ)}₁+{dot over (β)})]

−^(k) I _(Sk) _(—) _(y) Sθ ₂ Sθ ₃{dot over (θ)}₂{dot over (β)}  (68)

^(k) M _(kz)=−^(a) M _(F/T) _(—) _(x) Sθ ₂+(^(a) M _(F/T) _(—) _(y) Sθ ₁−^(a) M _(F/T) _(—) _(z) Cθ ₁)Cθ ₂

+^(a) F _(F/T) _(—) _(x)(^(a) y _(F/T) Cθ ₁+^(a) z _(F/T) Sθ ₁)Cθ ₂

−^(a) F _(F/T) _(—) _(y)(^(a) x _(F/T) Cθ ₁ Cθ ₂−^(a) z _(F/T) Sθ ₂)

−^(a) F _(F/T) _(—) _(z)(^(a) x _(F/T) Sθ ₁ Cθ ₂+^(a) y _(F/T) Sθ ₂)

−m _(Ft) ^(o) {umlaut over (x)} _(a)(^(a) y _(Ft) Cθ ₁+^(a) z _(Ft) Sθ ₁)Cθ ₂

−m _(Ft) ^(o) ÿ _(a)[^(a) x _(Ft) C(β+θ₁)Cθ ₂+(^(a) y _(Ft) Sβ+ ^(a) z _(Ft) Cβ)Sθ ₂]

+m _(Ft)(^(o) {umlaut over (z)} _(a) +g)[^(a) x _(Ft) S(β+θ₁)Cθ ₂+(^(a) y _(Ft) Cβ− ^(a) z _(Ft) Sβ)Sθ ₂]

+^(k) I _(Sk) _(—) _(z) [Sθ ₂({umlaut over (θ)}₁+{umlaut over (β)})+{umlaut over (θ)}₃]

+{^(a) I _(Ft) _(—) _(x) Sθ ₂ +m _(Ft)[^(a) x _(Ft)(^(a) y _(Ft) Sθ ₁−^(a) z _(Ft) Cθ ₁)Cθ ₂+(^(a) y _(Ft) ²+^(a) z _(Ft) ²)Sθ ₂]}{umlaut over (β)}

+[−m _(Ft) ^(a) x _(Ft)(^(a) y _(Ft) Sθ ₁+^(a) z _(Ft) Cθ ₁)+(^(k) I _(Sk) _(—) _(y)−^(k) I _(Sk) _(—) _(x))Cθ ₂ Sθ ₃ Cθ ₃ ]Cθ ₂{dot over (β)}²

+Cθ ₂[^(k) I _(Sk) _(—) _(z)+(^(k) I _(Sk) _(—) _(y)−^(k) I _(Sk) _(—) _(x))C(2θ₃)]({dot over (θ)}₁+{dot over (β)}){dot over (θ)}₂

+(^(k) I _(Sk) _(—) _(x)−^(k) I _(Sk) _(—) _(y))Sθ ₃ Cθ ₃[{dot over (θ)}₁ ² C ²θ₂−{dot over (θ)}₂ ²]

+2(^(k) I _(Sk) _(—) _(x)−^(k) I _(Sk) _(—) _(y))C ²θ₂ S(2θ₃){dot over (θ)}₁{dot over (β)}  (69)

Thus, all moments and forces at knee and ankle are obtained. With close observation of (53), (55), (56), (57), (64), (65), (66), (67), (68) and (69), it is clear that the knee and ankle moments and forces can be computed in real-time with online measurements of four angles (i.e., footplate angle (β), dorsiflexion/planar-flexion angle θ₁, inversion/eversion angle θ₂, shank internal/external rotation angle θ₃), which can be measured with the 6-DOF goniometer in FIG. 5 and FIG. 6, and three forces and three moments acting on foot (i.e., ^(a)F_(F/T) _(—) _(x), ^(a)F_(F/T) _(—) _(y), ^(a)F_(F/T) _(—) _(z), ^(a)M_(F/T) _(—) _(x), ^(a)M_(F/T) _(—) _(y), ^(a)M_(F/T) _(—) _(z)), which can be measured with the 6-axis F/T sensor. Note that, two of the moments applied from footplate to foot (^(a)M_(F/T) _(—) _(x) and ^(a)M_(F/T) _(—) _(y)) are not required for calculation of moments of lower limb joints, if foot is not strapped to footplate (Winter, 2005).

Of course, mass of shank and foot (m_(Sk), m_(Ft)) inertias of shank (^(k)I_(Sk) _(—) _(x), ^(k)I_(Sk) _(—) _(y), ^(k)I_(Sk) _(—) _(z)) and foot (^(a)I_(Ft) _(—) _(x)), and segment lengths (L_(Sk), L_(Sk) _(—) _(com)) are also required. However, these are constant values for each subject and can be measured/estimated offline. Masses and inertias can be estimated by referring anthropometric data (Winter, 2005; Zatsiorsky, 2002), and segment lengths can be either measured using a simple digitizer (e.g., Microscribe or a digitizing probe of Optotrak) or estimated by referring anthropometry (Winter, 2005; Zatsiorsky, 2002).

Variables needed to be measured from the goniometer and force/torque sensor below the foot in real-time for calculation of each joint moment and for are listed in Table I as a summary. Clearly, one can see depends on the joint and forces/moments of interest, number of required variables vary.

3. Feasibility Testing Experiment

1) A Sample Experimental Setup

A modified ET (e.g., Reebok Spacesaver RL) was instrumented with 6-axis F/T sensors (e.g., JR3 Inc., Woodland, Calif.) on both sides underneath the footplate. The ankle joint center (JC), midpoint between the medial and lateral malleoli, was aligned with the F/T sensor center. One end of the 6-DOF goniometer was attached to the footplate and the other end was strapped to the bony frontal-medial surface of shank. To corroborate the estimated Knee Adduction Moment (KAM) using the 6-DOF goniometer, an Optotrak 3020 system with 3 sets of markers (4 markers/set attached to a rigid shell) attached on thigh, shank, and foot was also used. The F/T and goniometer data were sampled at 1 KHz and the Optotrak data at 50 Hz. The foot was strapped to the footplate with no relative motions to the footplate. As an initial calibration, the subject stood still and initial knee JC coordinates with respect to the ankle frame was determined. From anthropometry data (Winter, 2005; Zatsiorsky, 2002), lengths—between knee JC and COM of shank and between knee JC and ankle JC—and masses and inertias with respect to COM of foot and to that of shank were obtained. With all the measured/estimated kinematic and kinetic variables, KAM was computed with respect to the knee local coordinate system and displayed as external KAM following the convention in (Foroughi et al., 2009).

2) Results

The KAM during stepping movement was estimated on a healthy volunteer (male, age: 32; height: 181 cm; mass: 97 kg). Strong KAM was generated during the stepping movement and the moment varied systematically with the stepping cycle (FIG. 6 (a)). When the subject adducted the knee during stepping, the KAM increased markedly (FIG. 6( b)). Furthermore, KAM estimated using the 6-DOF goniometer matched closely with that using the Optotrak and especially the peak KAM locations in each cycle with the 6-DOF goniometer and that with Optotrak are almost identical, thereby confirming the effectiveness of the proposed method.

REFERENCES

-   Baker R. Gait analysis methods in rehabilitation. Journal of     NeuroEngineering and Rehabilitation, 2006; 3: 4. -   Barrios J A, Crossley K M, Davis I S. Gait retraining to reduce the     knee adduction moment through real-time visual feedback of dynamic     knee alignment. Journal of Biomechanics, 2010; 43: 2208-13. -   Cohen A, Orin D E, Marsolais E. The gait laboratory force plate at     the Cleveland VA Medical Center. Bull Prosthet Res, 1980; 17: 90-7. -   Craig J J. Introduction to robotics: mechanics and control, 2nd ed.     Addison-Wesley New York, 1989. -   Elftman H. Forces and energy changes in the leg during walking.     American Journal of Physiology—Legacy Content, 1939; 125: 339-56. -   Foroughi N, Smith R, Vanwanseele B. The association of external knee     adduction moment with biomechanical variables in osteoarthritis: A     systematic review. The Knee, 2009; 16: 303-9. -   Hurwitz D E, Ryals A B, Case J P, Block J A, Andriacchi T P. The     knee adduction moment during gait in subjects with knee     osteoarthritis is more closely correlated with static alignment than     radiographic disease severity, toe out angle and pain. Journal of     Orthopaedic Research, 2002; 20: 101-7. -   Komistek R D, Dennis D A, Northcut E J, Wood A, Parker A W, Traina     S M. An in vivo analysis of the effectiveness of the osteoarthritic     knee brace during heel-strike of gait. The Journal of Arthroplasty,     1999; 14: 738-42. -   Koontz A M, McCrory J L, Cham R, Yang Y, Wilkinson M. Rehabilitation     Biomechanics. John Wiley & Sons, Inc., 2006. -   Lawrence R C, Felson D T, Helmick C G, Arnold L M, Choi H, Deyo R A,     Gabriel S, Hirsch R, Hochberg M C, Hunder G G, Jordan J M, Katz J N,     Kremers H M, Wolfe F, National Arthritis Data W. Estimates of the     prevalence of arthritis and other rheumatic conditions in the United     States: Part II. Arthritis & Rheumatism, 2008; 58: 26-35. -   Lee S J, Ren Y, Geiger F, Chang A H, Press J M, Zhang L-Q.     Improvement in off-axis neuromuscular control through pivoting     elliptical training: Implication for knee injury prevention. 2010     Annual International Conference of the IEEE Engineering in Medicine     and Biology Society (EMBC) Buenos Aires, Argentina, 2010: 4846-9. -   Miyazaki T, Wada M, Kawahara H, Sato M, Baba H, Shimada S. Dynamic     load at baseline can predict radiographic disease progression in     medial compartment knee osteoarthritis. Annals of the Rheumatic     Diseases, 2002; 61: 617-22. -   Pollo F E, Otis J C, Backus S I, Warren R F, Wickiewicz T L.     Reduction of Medial Compartment Loads with Valgus Bracing of the     Osteoarthritic Knee. The American Journal of Sports Medicine, 2002;     30: 414-21. -   Reeves N D, Bowling F L. Conservative biomechanical strategies for     knee osteoarthritis. Nat Rev Rheumatol, 2011; 7: 113-22. -   Ren Y, Park Hs, Wu Y-N, Geiger F, Zhang L-Q. Training for knee     injury prevention using a pivoting elliptical machine. Intl Conf of     the IEEE EMBS 2008: Vancouver, BC Canada, 2008: 727-30. -   Riley P O, Della Croce U, Casey Kerrigan D. Effect of age on lower     extremity joint moment contributions to gait speed. Gait & Posture,     2001; 14: 264-70. -   Sharma L, Hurwitz D E, Thonar EJMA, Sum J A, Lenz M E, Dunlop D D,     Schnitzer T J, Kirwan-Mellis G, Andriacchi T P. Knee adduction     moment, serum hyaluronan level, and disease severity in medial     tibiofemoral osteoarthritis. Arthritis & Rheumatism, 1998; 41:     1233-40. -   Shelburne K B, Torry M R, Steadman J R, Pandy M G. Effects of foot     orthoses and valgus bracing on the knee adduction moment and medial     joint load during gait. Clinical Biomechanics, 2008; 23: 814-21. -   Shiavi R, Limbird T, Frazer M, Stivers K, Strauss A, Abramovitz J.     Helical motion analysis of the knee I. Methodology for studying     kinematics during locomotion. J. Biomech., 1987; 20: 459-69. -   Simic M, Hinman R S, Wrigley T V, Bennell K L, Hunt M A. Gait     modification strategies for altering medial knee joint load: A     systematic review. Arthritis Care & Research, 2011; 63: 405-26. -   Thorp L E, Sumner D R, Wimmer M A, Block J A. Relationship between     pain and medial knee joint loading in mild radiographic knee     osteoarthritis. Arthritis Care & Research, 2007; 57: 1254-60. -   Whittle M W. Clinical gait analysis: A review. Human Movement     Science, 1996; 15: 369-87. -   Winter D A. Biomechanics and Motor Control of Human Movement, 3rd     ed. John Wiley & Sons, Inc.: Hoboken, N.J., 2005. -   Winter D A. Kinematic and kinetic patterns in human gait:     Variability and compensating effects. Human Movement Science, 1984;     3: 51-76. -   Winter D A. Overall principle of lower limb support during stance     phase of gait. Journal of Biomechanics, 1980; 13: 923-7. -   Zatsiorsky V. Kinetics of Human Motion. Human Kinetics Publishers:     Champaign, Ill., 2002. -   Zhang L-Q, Shiavi R G, Limbird T J, Minorik J M. Six     degrees-of-freedom kinematics of ACL deficient knees during     locomotion—compensatory mechanism. Gait & Posture, 2003; 17: 34-42. -   Zhou H, Hu H. Human motion tracking for rehabilitation—A survey.     Biomedical Signal Processing and Control, 2008; 3: 1-18.     Some exemplary embodiments are shown and described, other similar     embodiments can be made by changing these exemplary embodiments     without departing from the principles and spirit of the inventive     concept as defined by the following claims, the scope of which is     defined in the appended claims and their equivalents. 

1. In a coordinate system of an exercise apparatus 100 wherein a generally up and down Z-axis defines an axial rotation axis, a generally front to back Y-axis defines a coronal axis and a generally left to right X-axis defines a sagittal axis, the lower-limb joint moment real-time feedback training apparatus and system comprising: A multi-axis force sensor 1; said force sensor 1 is mounted on the moving arm of said exercise device 100 and moves together with the moving arm in the said sagittal plane, A footplate 2; it is attached to the said force sensor 1 and supports the human foot/shoe, A compact real-time lower-limb motion measurement unit 3G and 3I; said motion measurement unit 3G and 3I can be attached to the lower limb segments and measures lower-limb joint motion in multiple degrees of freedom (DOF), A central processor 4; said processor 4 incorporates the multi-axis force sensor 1, motion measurement unit 3G and 3I and limb geometry information and calculates lower-limb joint moments in real time, A feedback device 5; said device 5 displays the lower-limb joint moments and/or generates sound or haptic feedback based on the amplitude and/or timing of the joint moments in real-time.
 2. The apparatus of claim 1 wherein said lower-limb real-time motion measurement unit 3G and 3I can be one or more multi-DOF goniometer 3G or multi-DOF inertial measurement units (IMU) 3I.
 3. The apparatus of claim 2 wherein said multi-DOF goniometer 3G; the one end of said goniometer sensor 3G is attached to the said footplate 2, and the other end is attached to the leg; said multi-DOF goniometer 3G is used to measure ankle dorsiflexion/planar-flexion and inversion/eversion angles and shank internal/external rotation angle in real-time.
 4. The apparatus of claim 2 wherein said IMUs are attached to the foot and leg; said IMUs are used to measure ankle dorsiflexion/planar-flexion and inversion/eversion angles and shank internal/external rotation angle in real-time.
 5. The apparatus of claim 2 wherein said IMUs is attached to the leg and thigh; said IMUs are used to measure knee flexion/extension, abduction/adduction (valgus/varus) angle and shank internal/external rotation angle in real-time.
 6. The apparatus of claim 1 wherein said footplate 2 further comprising a foot bootstrap 6, which straps the foot to the footplate and prevents motion of the foot relative to the footplate.
 7. The apparatus of claim 1 wherein said exercise apparatus 100 comprises a pivoting and/or a sliding 8 mechanisms so as to induce or apply a pivoting and/or sliding movement to the footplate 2, said pivoting movement being substantially about an axis parallel to the said Z axis or about an axis parallel to the Y axis; and said sliding movement being along the said X and Y axes.
 8. The apparatus of claim 1 wherein the force sensor 1 further includes a multi-axis force sensor, said multi-axis force sensor measures at least one of said three ground-reaction forces along said X, Y and Z axes and at least one of said three moments about said X, Y and Z axes.
 9. The apparatus of claim 1 further comprising a real-time central processor 4, said central processor implements a real-time calculation method 9 of interested lower-limb joint moments based on said multi-axis force sensor and lower-limb motion measurement unit.
 10. The central processor 4 of claim 9 further implements a real-time calculation method 9 requiring real-time measurement of one or more components of said three ground-reaction forces along said X, Y and Z axes and three moments about said X, Y and Z axes when the said foot strap is used: Computing one direction ankle force requires only the same direction component of the said ground-reaction forces; Computing one direction ankle moment requires two components of said ground-reaction forces, direction of which are orthogonal to the direction of the said one direction ankle moment, and one moment measured from the said multi-axis force sensor 1, direction of which are the same as said one direction ankle moment; Computing one direction knee force requires the said all three ground-reaction forces along said X, Y and Z axes; Computing one direction knee moment requires the said all three ground-reaction forces along the said X, Y and Z axes, and the said three moments about the said X, Y and Z axes.
 11. The central processor 4 of claim 9 further implements a real-time calculation method 9 requiring real-time measurement of one or more components of the said three ground-reaction forces along the said X, Y and Z axes and three moments about the said X, Y and Z axes when the said foot bootstrap 6 is not used: Computing one direction ankle force requires only the same direction component of the said ground-reaction forces; Computing one direction ankle moment requires two components of the said ground-reaction forces, direction of which are orthogonal to the direction of the said one direction ankle moment, and the said axial axis moment measured from the said multi-axis load sensor; Computing one direction knee force requires the said all three ground-reaction forces along the said X, Y and Z axes; Computing one direction knee moment requires the said all three ground-reaction forces and the said axial axis moment measured from the said multi-axis load sensor.
 12. The central processor of claim 9 further implements a real-time calculation method 9 requiring real-time measurement of lower-limb kinematic variables when the foot strap 6 is used: Computing the said sagittal axis direction ankle force requires the said sagittal axis direction translational acceleration of the ankle joint; Computing the said coronal or axial direction ankle force requires the said coronal and axial direction translational acceleration of ankle joint and the said sagittal axis angle, angular velocity, and angular acceleration of foot; Computing the said sagittal direction ankle moment requires the said coronal and axial direction translational accelerations of ankle joint and the said sagittal axis angle and angular acceleration of foot; Computing the said coronal or axial direction ankle moment requires all three direction translational accelerations of ankle joint and the said sagittal axis angle, angular velocity, and angular acceleration of foot; Computing the said sagittal or coronal direction knee force requires the said all three X, Y and Z direction translational accelerations of ankle joint, the said sagittal axis angle, angular velocity and angular acceleration of foot, and the said ankle dorsiflexion/planar-flexion and inversion/eversion angles and shank internal/external rotation angle and the 1^(st) and 2^(nd) time derivatives of the said ankle dorsiflexion/planar-flexion and inversion/eversion angles; Computing the said axial direction knee force requires the said all three X, Y and Z direction translational accelerations of ankle joint, the said sagittal axis angle, angular velocity and angular acceleration of foot, and the said ankle dorsiflexion/planar-flexion and inversion/eversion angles and 1^(st) time derivatives of the said ankle dorsiflexion/planar-flexion and inversion/eversion angles; Computing the said sagittal and coronal direction knee moments requires the said all three X, Y and Z direction translational accelerations of ankle joint, the said sagittal axis angle, angular velocity and angular acceleration of foot, and the said ankle dorsiflexion/planar-flexion and inversion/eversion angles and shank internal/external rotation angle, the 1^(st) time derivatives of the said ankle dorsiflexion/planar-flexion and inversion/eversion angles and shank internal/external rotation angle, and the 2^(nd) time derivatives of the said ankle dorsiflexion/planar-flexion and inversion/eversion angles; Computing the said axial direction knee moment requires the said all three X, Y and Z direction translational accelerations of ankle joint, the said sagittal axis angle, angular velocity and angular acceleration of foot, and the said ankle dorsiflexion/planar-flexion and inversion/eversion angles and shank internal/external rotation angle, the 1^(st) time derivatives of the said ankle dorsiflexion/planar-flexion and inversion/eversion angles, and the 2^(nd) time derivatives of the said ankle dorsiflexion/planar-flexion angle and the said shank internal/external rotation angle;
 13. The apparatus of claim 1 wherein said apparatus can be configured as a pair of joint moment measuring assemblies and attached on each footplate on said exercise device.
 14. The apparatus of claim 7 further comprising a motor 10, said motor 10 being operatively engaged with at least one of said pivoting 7 or said sliding motion 8 to drive the pivoting and/or sliding movements, wherein said motor 10 is configured to exert a preconfigured force to change knee loading moments.
 15. The apparatus of claim 7 further comprising position sensor 11, said position sensor 11 operatively measures the internal/external pivoting motion of foot. 